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ABSTRACT 

J 

Th*  feasibility  of  controlling  a  flexible  one ~ link 
aanipulator  with  an  adaptive  computer  simulation  model , 
called  a  curve  following  system,  is  investigated.  At  the 
beginning  a  very  flexible  unloaded  arm  is  used.  Later  the 
stiffness  of  the  arm  is  increased,  until  we  reach  the  case  of 
a  flexible  arm  that  can  be  used  in  practice.  Finally  load  is 
added  to  the  arm  and  its  behavior  is  studied. 
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I.  INTRODUCTION 


A.  BACKGROUND 

In  recent  years  an  increasing  use  of  programmable 
manipulators,  or  robots  as  often  called,  has  taken  place, 
as  a  result  of  the  need  to  increase  industrial 
productivity.  Beyond  the  use  of  these  devices  in  manufactu¬ 
ring  processes,  they  are  also  used  to  perform  tasks  in 
environments  hazardous  to  humans,  such  as  radioactive 
material  handling,  operations  and  maintenance  inside  nuclear 


reactors , 

etc . 

Furthermore  the  use 

of 

robots  in 

space 

missions 

is  a 

fact  and  their  use 

in 

exploratory 

space 

missions,  where  a  considerably  high  risk  for  the  astronauts 
exists,  is  a  necessity. 

The  trend  towards  "programmable  manipulators"  is  dictated 
by  the  fact  that  such  devices  can  perform  a  wide  range  of 
jobs,  by  simply  changing  the  program  that  controls  them, 
reducing  considerably  the  overall  cost. 

Robots  are  essentially  mechanical  manipulators,  with 
several  degrees  of  freedom,  typically  six,  to  be  capable  of 
performing  tasks  similar  to  that  of  a  human  hand.  They  can  be 
identified  as  consisting  of  three  parts:  the  manipulator 
(arm),  the  controller  and  the  power  supply. 

The  manipulator  of  the  robot  performs  the  actual  job.  It 
essentially  consists  of  links,  joints  and  actuators.  The 


brain  of  the  robot  is  the  controller  which  directs  the  motion 
of  the  manipulator .  Finally  the  power  supply  provides  the 
energy  required  for  the  operation  of  the  whole  system. 

Despite  the  amount  of  work  done  in  the  past  in  the  field 
of  robotics,  one  of  the  major  drawbacks  of  today's  robots  is 
the  low  speed  of  operation.  The  speed  is  greatly  limited  by 
the  weight  of  the  manipulator  arm.  At  present  the  ratio  of 
arm  weight  to  payload  is  of  the  order  of  10  to  1.  This 
excessive  arm  weight  not  only  hampers  the  motion  of  the 
manipulator  arm,  but  also  increases  the  size  of  the  required 
actuators  as  well  as  the  power  consumption.  To  overcome  this 
problem,  a  lot  of  design  effort  nowadays  is  geared  towards 
building  of  straight,  stiff  and  light  links,  for  which, 
however,  the  manufacturing  cost  is  high. 

A  flexible  manipulator  is  free  of  these  drawbacks.  It  has 
slender  links  which  are  considerably  more  rigid  in  compressi¬ 
on  than  in  flexure  and  therefore  requires  less  material,  has 
less  weight,  consumes  less  power  and  has  more  maneuverability 
than  traditional  heavy  manipulators.  Furthermore  with  the 
lower  power  demand,  smaller  actuators  can  be  used  resulting 
in  an  overall  lower  cost  and  lower  total  weight  for  the 
3ystem.  This  reduced  weight  enhances  the  transportability  of 
the  whole  system,  a  feature  very  attractive  for  space 
applications . 

In  spite  of  these  advantages,  flexible  manipulators  have 
not  been  much  favored  in  the  production  industries.  Some  of 
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the  reasons  are  as  follows:  Manipulator  arms  require  a 
reasonable  accuracy  in  the  response  of  the  end  point  (tip), 
to  commands  applied  at  the  joints.  This  accuracy  is 
deteriorated  by  structural  deformation  when  the  arm  is 
flexible,  especially  when  the  deformation  is  oscillatory. 
Traditionally,  these  oscillations  have  been  eliminated  by 
increasing  the  rigidity  of  the  arms,  and  this  is  exactly  what 
we  want  to  avoid  with  the  use  of  flexible  arms,  if  we  are  not 
to  sacrifice  their  advantage.  Also  the  dynamics  of  flexible 
links  is  extremely  complex  and  non-linear  and  obviously  more 
difficult  to  analyze. 

B.  REVIEW  OF  PREVIOUS  WORK 

[Ref.  1]  uses  a  very  flexible  arm  on  which  control 
techniques  are  applied  for  the  precise  tip  positioning.  The 
controller  used  is  linear  and  its  design  is  based  on  optimal 
control  theory.  This  control  scheme  results  in  a  fast 
positioning  of  the  tip  of  the  arm,  but  it  is  only  valid  for 
small  displacements,  because  otherwise  the  motor  is  driven  to 
saturation  limits.  When  the  motor  saturates  the  whole  control 
scheme  is  rendered  invalid. 

Nevertheless  the  solution  given  in  this  reference  works 
very  well  and  the  results  have  been  verified  experimentally. 

[Ref.  2]  presents  the  method  for  modelling  a  multi-link 
arm  with  all  links  being  flexible.  It  uses  series  expansion 
about  the  operating  point  in  order  to  obtain  a  linear  model 
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for  the  manipulator.  Application  of  optimal  control  theory  is 
used  for  the  control  of  a  manipulator  with  two  flexible 
links,  without  providing  the  intermediate  steps  followed. 


[Ref.  3]  uses  an  adaptive  model  for  the  positioning  of  a 
two-link  rigid  arm.  This  scheme  results  in  a  near  minimum 
time  solution,  with  very  high  accuracy  of  the  end  point 
position.  The  scheme  used  is  customarily  called  velocity 
curve  following,  and  it  is  widely  used  in  high  performance 
disk  drives.  The  complete  description  of  this  scheme  is  given 
in  [Ref.  4]. 

[Ref.  5]  shows  the  implementation  of  the  controller  used 
in  [Ref.  3]  in  a  micro-computer,  for  an  one- link  rigid  arm. 
The  performance  of  the  controller  is  excellent  and  verifies 
the  theoretical  results  of  [Ref.  3]  and  [Ref.  4]  ensuring  the 
applicability  of  the  controller  in  actual  hardware. 

C.  OBJECTIVE  OF  THE  THESIS 

In  this  thesis  a  feasibility  study  of  the  application  of 
the  velocity  curve  follow  technique  to  the  flexible  arms  will 
be  done.  The  advantage  of  this  technique  is  its  simplicity 
and  as  shown  in  [Ref.  4]  and  [Ref.  5],  it  can  easily  be 
implemented  in  a  micro-computer.  Another  advantage  of  this 
technique  is  its  adaptive  nature.  Through  the  adaptation 
procedure  it  accounts  for  modelling  uncertainties, 
unpredictable  environmental  changes,  and  noise  contamination 
of  the  signals. 


17 


The  same  arm  used  in  £Ref .  1]  will  be  used  in  this  thesis 
in  order  to  have  a  comparison  basis  for  the  results  and 
because  the  model  for  this  arm  is  well  documented. 

The  effect  of  the  arm’s  stiffness  on  the  curve  follow 
scheme  will  also  be  studied.  This  study  is  considered 
necessary  in  the  sense  that  the  arm  we  are  going  to  use  is  an 
extremely  flexible  arm  and  not  applicable  in  any  practical 
situation.  It  is  therefore  necessary  to  have  an  idea- -at 
least — of  how  the  proposed  scheme  works  with  a  more  realistic 
flexible  manipulator. 

D.  THESIS  ORGANIZATION 

In  Chapter  II  the  model  of  the  arm  will  be  given.  As 
mentioned  earlier  the  model  used  in  [Ref.l]  will  be  used  in 
this  thesis  for  it  is  well  documented  and  will  provide  a 
comparison  basis  for  the  results. 

Some  preliminary  studies  on  the  model  will  be  performed 
in  Chapter  III.  These  will  include  time  and  frequency 
response  of  the  system  which  will  help  to  reveal  the 
prominent  physical  characteristics  of  the  arm. 

In  Chapter  IV  the  velocity  curve  following  control  system 
will  ce  developed  and  simulated. 

In  Chapter  V  an  investigation  will  be  done  on  whether  or 
not  the  curve  follow  scheme  can  be  applied  for  the  control  of 
a  flexible  arm. 
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In  Chapter  71  son*  control  schemes  will  be  used  and 
simulated  as  a  supplement  to  the  curve  follow  system  for  the 
accurate  control  of  the  tip  of  the  arm. 

effect  of  the  arm’s  stiffness  on  the  curve  follow 
scheme  will  be  studied  in  Chapter  VII. 

While  in  all  chapters  the  unloaded  arm  will  be  used,  in 
Chapter  IIX  the  simulation  results  of  the  motion  of  the  arm 
with  load  will  be  presented.  Some  general  remarks  will  be 
drawn  and  areas  for  future  study  will  be  outlined,  which  will 
help  make  the  control  scheme  derived  for  the  unloaded  arm,  to 
work  with  any  load. 

Chapter  IX  will  conclude  the  thesis  and  recommendations 
for  further  study  will  be  given  in  the  same  chapter. 


i 


II.  MATHEMATICAL  MODEL  OF  THE  ARM 


A.  OVERVIEW 

The  modelling  of  a  flexible  arm  is  by  no  means  an  easy 
task.  The  dynamics  of  a  robot  arm,  even  in  the  case  of  a 
rigid  body,  is  highly  nonlinear  and  complex.  The  effective 
inertia  of  the  whole  system  changes  as  the  geometric 
configuration  of  the  manipulator  arm  changes  with  its  motion. 
When  we  use  high  speeds  for  the  motion  of  the  arm,  coriolis 
effects  cannot  be  neglected.  Adding  flexural  dynamics  makes 
the  problem  very  complex. 

The  dynamics  of  a  flexible  arm  can  be  most  appropriately 
represented  by  a  distributed  (continuous)  system  model.  This 
approach  results  in  a  set  of  partial  differential  equations 
of  infinite  dimensions.  Such  an  infinite  dimensional  model 
cannot  be  used  for  the  design  of  the  controller  of  the 
system.  The  usual  approach  is  to  resort  to  a  finite  element 
representation  in  order  to  obtain  a  finite  order  system  on 
which  control  design  will  be  based.  This,  however,  causes 
some  problems,  because  we  try  to  control  the  actual  system 
with  a  controller  whose  design  is  based  on  an  'incorrect" 
model . 

Fortunately  this  finite  order  model  produces  reasonably 
accurate  approximation  for  the  low  frequency  structural  mode. 
The  accuracy  for  the  higher  mode  frequencies  and  shapes  is 
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often  poor  [Ref.  6],  but  with  insignificant  effects  for  the 
control  design. 

From  Analytical  Mechanics  we  see  that  the  most  commonly 
used  methods  to  model  complex  structures  with  a  distributed 
parameter  nature  is  the  Lagrange  and  the  Hamiltonian  methods . 

[Ref.  7]  describes  these  two  methods  and  gives  several 
illustrative  examples  for  their  use. 

B.  DERIVATION  OF  THE  MATHEMATICAL  MODEL 

[Ref.  1]  uses  both  Hamilton’s  and  Lagrange’s  formalism  to 
derive  the  mathematical  model  of  an  experimental  flexible 
arm,  moving  on* the  horizontal  plane  as  shown  in  Figure  2.1. 
The  mathematics  involved  are  fairly  complex  and  for  the 
complete  solution  the  reader  is  referred  to  [Ref.  1]. 

The  resulting  model  is  linear  and,  as  mentioned  in 
Chapter  I,  it  is  the  model  that  will  be  used  in  the  course  of 
this  thesis.  In  that  experimental  arm  three  sensors  are  used 
in  order  to  measure  various  signals.  One  sensor  is  located  at 
the  hub  of  the  arm  (point  0  in  Figure  2.1)  which  measures  the 
hub  angle  of  the  arm.  A  Strain- gauge  sensor  is  located  close 
to  the  hub  which  measures  the  strain  that  the  arm  undergoes 
and  a  third  sensor  is  located  at  the  tip  of  the  arm  which 
measures  the  position  of  the  tip  of  the  arm. 

The  transfer  functions  from  torque  at  the  hub  of  the  arm 
to  the  various  sensors  are  as  follows. 
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For  the  case  of  unloaded  arm  (no  payload)  we  have. 
Collocated  hub  angle  sensor: 

9(s)  46. 321 (s+0. Il±j3.34)(s+0.29±jl7.47)(s+0.69±j46.44) 

T(s)  s(s+0 . 2) ( s+0 .17±jll.79)( s+0 . 4± j21 . 61 ) ( s+0 . 72± j48 . 07 ) 

Tip  position  sensor: 

yt  (s)  -2.177(s-12.04)(s+12.14)(s+22.38±j24.2)(s-21.52±j25.3) 

T(s)  s(s+0 . 2)  ( s+0  . 17±jll.79)  (s+0 . 4±j21.61)(  s+0 . 72± j48 . 07 ) 

For  the  case  of  loaded  arm  with  a  tip  mass  equal  to  0 . 229 
Kg,  the  transfer  functions  are  as  follows. 

Collocated  hub  angle  sensor: 

0(s)  44 . 314 (s+0 . 82± J41 . 7 ) (s+0 . 24±jl4 . 509) (s+0 . 1± j2. 47 ) 

T(s)  s(s+0 . 2) (S+0 . 87± j43. 53) (s+0 . 4± J19 . 4 ) ( s+0 . 15± jlO . 1 ) 

Tip  position  sensor: 

yt (s)  -0.714(s-12.74)( s+12 . 89 ) ( s+20 .7±j22.94)(s-19.9±j24.4) 

T(s)  s(s+0 . 2) ( s+0 . 87± J43 . S3 ) ( s+0 . 4± jl9 . 4 ) (s+0 . 1± jlO . 1 ) 

In  both  cases  the  transfer  functions  from  torque  to  strain- 
gauge  sensor  are  omitted  because  we  are  not  going  to  use  them 
throughout  this  thesis. 

The  units  are:  "rad"  for  hub  angle,  "meters"  for  tip 
position  and  "N*m"  for  torque. 
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The  inertia  of  the  unloaded  arm  (without  the  tip  mass)  is 
0.44  Kg»m2 ,  while  for  the  loaded  arm  is  0.73  kg«m2 ,  which 
corresponds  to  an  increase  of  66  %. 

The  phzsical  dimensions  and  other  parameters  for  the  arm 
are  given  in  Table  2.1. 


A.  INTRODUCTION 


Before  we  proceed  with  the  design  of  a  controller  for  the 
flexible  arm,  it  is  helpful  to  perform  some  preliminary 
studies  on  the  model  of  the  arm,  in  order  to  obtain  some 
feeling  of  the  prominent  physical  properties  of  the  system. 

Without  this  physical  insight  of  the  system  no  reasonable 
control  design  can  be  done  and  the  interpretation  of  the 
results,  after  the  application  of  any  control  scheme  will  be 
difficult  if  not  incorrect. 

B.  ANALYSIS  OF  THE  MODEL  OF  THE  ARM 

l.  loflaansr  Roaponag 

In  Figures  3.1  through  3.4  the  frequency  response  for 
all  transfer  functions  is  given.  For  the  derivation  of  these 
plots  the  software  package  "CONTROLS"  was  used. 

In  Figures  3.1  and  3.2  we  see  the  open  loop  frequency 
response  of  the  hub  and  tip  motion,  with  the  arm  carrying  no 
Load.  We  observe  that  the  hub  motion  has  three  resonance 
frequencies  with  the  lower  one  at  about  10  rad/sec.  The  two 
first  resonant  frequencies  have  magnitude  greater  than  zero 
db.  If  the  arm  were  modelled  by  an  infinite  element  approach 
the  resonant  frequencies  would  be  infinitely  many.  However, 


Figure  3 . 1  Open  Loop  Frequency  Response  Of  The  Hub  | 

Transfer  Function  (Ana  Unloaded).  j 
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Figure  3.2  Open  Loop  Frequency  Response  Of  The  Tip 
Transfer  Function  (Arm  Unloaded). 
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Fifure  3.3  Open  Loop  Frequency  Response  Of  The  Hub 
Transfer  Function  (Arm  Loaded). 
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Figure  3.4  Open  Loop  Frequency  Response  Of  The  Tip 
Transfer  Function  (Arm  Loaded). 


FREQUENCY  (rad/sec) 


we  see  -that  even  the  third  resonant  frequency  is 
insignificant  since  its  peak  is  at  about  -30  db,  and  we  can 
say  that  the  finite  element  approach  used  in  Chapter  II  for 
the  modelling  of  the  flexible  arm  is  sufficiently  good.  The 
phase  margin  for  the  hub  transfer  function  is  12* . 

From  the  open  loop  frequency  response  of  the  tip 
transfer  function  we  see  that  only  one  resonant  frequency 
exceeds  the  zero  db  level  and  it  is  at  about  10  rad/sec, 
which  is  the  same  frequency  as  in  the  case  of  the  hub 
transfer  function.  Therefore  if  a  filter  were  to  be  used  to 
eliminate  the  effects  of  this  resonance,  it  would  have  the 
same  good  effects  on  both  hub  and  tip  transfer  functions . 
Another  significant  observation  on  Figure  3.2  is  its 
nonminimum  phase  character.  In  the  lower  frequencies,  the 
magnitude  has  a  slope  of  -40  db/dec  but  the  phase  does  not 
pass  through  -180°.  This  is  the  effect  of  the  nonminimum 
phase  zeros . 

Similar  observations  hold  for  the  open  loop  frequency 
response  of  the  transfer  functions  that  correspond  to  the 
loaded  arm.  The  only  difference  is  that  the  crossover 
frequencies  as  well  as  the  resonances  have  been  moved  to  the 
left  by  0.4  rad/sec. 

2.  XiagJtespdnas  0f.Ihq..Aan 

The  second  set  of  preliminary  studies  of  the  arm  is 
its  time  response  and  is  presented  in  Figures  3.5  through 
3.8.  In  Figures  3.5  and  3.6  the  step  response  of  the  hub  and 
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Figure  3.6  Step  Response  Of  The  Tip  Transfer 
Function  (Arm  Unloaded). 
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Figure  3.7  Step  Response  Of  The  Hub  Transfer 
Function  (Arm  Loaded). 
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■tip  motion  of  the  unloaded  arm  are  shown.  The  oscillatory 


character  of  the  arm  is  obvious.  In  Figure  3.6  we  see  the 


delay  that  the  tip  motion  undergoes  as  a  response  to  a  torque 


at  its  hub,  and  also  the  initial  motion  of  the  tip  in  the 


opposite  direction.  This  is  an  intuitive  fact  and  is 


represented  mathematically  with  the  non-minimum  phase  zeros 


in  the  tip  transfer  functions. 


In  Figures  3.7' to  3.8  the  step  response  for  the  case 


of  the  arm  with  a  tip  load  are  shown,  and  they  do  not  differ 


appreciably  from  Figures  3.5  and  3.6. 
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A.  INTRODUCTION 


The  velocity  curve  follow  control  scheme  is  a  nonlinear 
adaptive  system  that  has  been  used  successfully  for  many 
years  in  disk  drive  systems.  Recent  studies  [Ref.  3]  show 
that  this  system  is  very  effective  in  the  control  of  rigid 
arms,  yielding  near  minimum  time  positioning.  The  nice 
feature  of  this  scheme  is  that  we  can  take  full  advantage  of 
all  the  power  available  in  the  motor  which  is  being  driven 
with  full  forward  or  full  reverse  power. 

This  feature  is  very  important.  In  all  linear  controllers 
we  have  to  avoid  driving  the  amplifier  to  saturation,  because 
this  condition  renders  the  controller  ineffective  [Ref.  1] 
and  [Ref.  2],  therefore  only  small  loads  are  used  and  small 
displacements  commanded. 

In  the  case  of  the  proposed  control  scheme  we  don’t  worry 
about  this  problem.  We  intentionally  drive  the  amplifier  to 
saturation  limits  so  that  we  can  take  full  advantage  of  the 
motor’s  capabilities. 

Furthermore  the  system,  being  adaptive,  eliminates  errors 
due  to  noise,  modelling  uncertainties  or  change  of  the  loads, 
and  environment.  Finally  the  system  is  simple  and  easily 


B.  DESCRIPTION  OF  THE  BASIC  SYSTEM 

The  curve  follow  scheme  is  shown  in  Figure  4.1.  This 

scheme  is  described  in  [Ref.  4]  and  we  will  follow  the  same 

reasoning,  making  the  necessary  changes  required  for  the 

application  of  the  system  to  the  control  of  the  flexible  arm. 

The  system  operates  in  two  modes  for  a  step  position  • 

command  (the  command  has  not  necessarily  to  be  a  step  as  it 

will  be  shown  later  in  this  chapter) :  An  initial  full 

acceleration  mode  and  a  curve  following  mode.  When  the  curve 

to  be  followed  is  chosen  to  be  the  deceleration  curve  for  an 

idealized  motor,  the  system  will  be  practically  the 

application  of  a  bang-bang  controller. 

When  a  step  input  is  applied  to  the  system,  the  error 

signal  (E)  will  enter  the  curve  and  produce  a  commanded 

♦ 

velocity  input  (X)  to  the  velocity  loop.  The  amplifier 
saturates  and  full  forward  signal  is  applied  to  the  motor 
(full  acceleration  mode).  As  the  position  error  signal 

decreases,  the  commanded  velocity  is  reduced  until  it  is 

% 

equal  to  the  velocity  feedback  signal  (KC).  Because  the 
commanded  velocity  signal  is  decreasing,  the  velocity  error 
(XE)  will  go  negative  and  cause  the  voltage  signal  to  the 
motor  to  reverse.  Using  a  relatively  high  amplifier  gain  Xs 
we  can  make  the  system  switch  between  positive  and 
negative  saturation  limits  and  follow  the  curve  down  until  it 
reaches  the  final  position. 
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C.  CURVE  DESIGN 


It  has  been  shown  in  [Ref.  4]  that  the  curve  can  be 
derived  from  the  idealized  motor  equations  as  follows: 

(4.1) 

(4.2) 

(4.3) 

When  we  solve  equation  4.3  for  t  and  substitute  in  equation 
4.3, 


+ 


2  Ka  Vast 


(4.4) 


For  deceleration  from  initial  conditions  with  the  input 
R  =  0, 

C  =  -E  (4.5) 

0  =  -E  ; 4 . 5 ) 


Finally  when  we  combine  equations  4.4,  4.5  and  4 . 6  we  have: 


The  parameters  Km  and  Va&t 


depend  upon  the  motor  and 


amplifier  to  be  used.  Letting: 
A  =  y  2  Kn  V»at 


(4.8) 


and 


(4.9) 


X  = 


commanded  velocity 


(4.10) 


Thus  the  commanded  velocity  curve  can  be  generated  by  an 
initial  calculation  of  the  parameter  A,  and  then  continuously 
multiplying  this  factor  by  the  square  root  of  the  position 
error.  The  resulting  commanded  velocity  is  a  parabola  which 
corresponds  to  the  deceleration  curve  of  an  ideal  motor.  As 
we  will  see  in  the  simulation  studies,  for  the  case  of  the 
flexible  arm,  this  curve  has  to  be  lowered  by  a  factor  of  the 
order  of  0.06,  therefore  we  multiply  the  commanded  velocity 
signal  by  Ki  =0.06. 

The  parameters  that  are  necessary  for  the  calculation  of 
the  curve  depend  upon  the  specific  actuator  that  we  wiil  use 
for  the  motion  of  the  arm.  The  second  order  model  gain 
constant  (Km)  is  determined  by  the  actuator  parameters  and 
the  effective  inertia  seen  by  the  actuator.  This  parameter  is 
going  to  be  updated  through  the  adaptation  algorithm  as  we 


will  sew  later  and  only  an  initial  value  need  be  given.  As 
shown  from  the  simulation  studies  the  best  value  for  K»  is 
1.2  rad/volt.  For  the  saturation  limits  of  the  amplifier  we 
use  Vast  =  50  volt.  Finally  for  the  gain  of  amplifier  Ka  we 
have  to  use  a  large  value  so  that  the  amplifier  is  driven 
into  saturation  limits  even  for  very  small  input  signals.  As 
such  Ka  =  10,000  was  chosen. 

D.  SIMULATION  STUDIES  OF  THE  BASIC  MODEL 

To  demonstrate  the  ability  of  this  scheme  to  follow  the 
curve,  the  model  was  simulated  using  DSL/VS.  The  DSL/VS 
program  is  listed  in  Appendix  A.  For  this  simulation  we  used 
K»  =  17  rad/volt  and  Vast  =  50  volt.  Figure  4.2  shows  the 
phase  plane  trajectories  (angular  velocity  fc  versus  angular 
position  C),  for  a  step  command  of  0.1  rad.  We  observe  that 
the  angular  velocity  of  the  model  increases  with  constant 
acceleration  until  the  curve  is  reached.  When  this  happens 
the  velocity  error  applied  to  the  amplifier  changes  sign  the 
voltage  to  the  motor  reverses  and  the  model  velocity  follows 
the  curve  until  the  commanded  position  is  reached.  The  step 
response  of  the  model  is  shown  in  Figure  4.3. 

It  was  mentioned  earlier  in  this  chapter  that  the 
commanded  input  (position)  need  not  be  a  step  for  the  model 
to  follow  the  curve.  This  is  shown  in  Figures  4.4  through  4.9 
for  the  case  of  the  inputs  shown  in  Figures  4.4  and  4.7. 


Figure  4.6  Response  Of  The  Model  To  The  Input 
Shown  In  Figure  4.4 
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Figure  4.8  Phase  Plane  Trajectories  Of  The  Model 
With  Input  As  In  Figure  4.7. 
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Figure  4.9  Response  Of  The  Model  To  The  Input 
Shown  In  Figure  4.7. 
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E.  THE  ADAPTIVE  ALGORITHM 


The  block  diagram  of  the  adaptive  system  for  the  flexible 
arm  is  shown  in  Figure  4.10.  The  signal  that  comes  out  of  the 
switching  amplifier  (saturating  amplifier),  is  common  to  both 
the  second  order  model  of  the  idealized  motor  and  to  the 
actual  system  (combination  of  real  motor  -  and  flexible  arm). 
This  scheme  is  used  to  "force"  the  actual  system  to  follow 
the  ideal  model  which  in  turn  is  adaptive  in  nature. 

The  hub  angle  (CR)  and  the  hub  angle  rate  (CR)  are 
measured  at  specified  time  intervals  (sampling  intervals)  and 
are  fed  back  into  the  adaptive  algorithm.  This  data  is  used 
to  calculate  the  gain  constant  of  the  ideal  model  (K»),  and 
to  update  the  states  of  the  ideal  model. 

The  reason  for  using  the  hub  angle  and  the  hub  angle  rate 
as  inputs  to  the  adaptive  algorithm  will  be  made  clear  in  the 
next  chapter.  At  present  it  suffices  to  say  that  the  tip 

t 

position  (YT)  and  the  tip  velocity  (YT)  are  not  appropriate 
inputs  for  the  adaptive  algorithm,  due  to  the  delay  in  the 
response  of  the  tip  to  torques  applied  at  the  hub  as  seen  in 
Figures  3.6  and  3.8. 

Due  to  that  delay  any  attempt  of  the  system  to  correct 
the  tip  position  does  not  have  instantaneous  results  on  the 
tip  motion.  Therefore  even  though  the  system  has  applied  the 
"correct  torque"  to  move  the  tip  as  required,  the  tip  does 
not  move  immediately  and  the  system  continues  applying  more 
torque  "thinking"  that  the  previously  applied  torque  was  not 
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sufficient.  On  the  other  hand  when  the  tip  has  a  position 
error  in  the  opposite  direction,  the  same  process  takes  place 
in  the  opposite  direction.  This  situation  drives  finally  the 
system  unstable  as  is  shown  in  the  next  chapter. 

The  gain  constant  Kb  of  the  model  is  not  kept  constant 
throughout  the  arm's  motion  but  is  adjusted  so  as  to  account 
for  the  inertia  reflected  back  from  the  arm.  The  adaptation 
algorithm  for  Kb  has  to  satisfy  two  basic  criteria.  One  is 
that  the  calculations  must  be  accurate  enough  in  order  that 
the  second  order  model  can  approximate  the  trajectory  of  the 
arm  as  closely  as  possible.  The  second  criterion  is  that  the 
calculations  must  be  simple  to  allow  fast  updating  of  Km ,  and 
be  easily  programmed  in  a  microprocessor. 

There  are  several  ways  to  satisfy  the  above  criteria.  For 
our  purpose  the  method  described  in  [Ref.  4]  best  satisfies 
both  criteria. 

Solving  equation  4 . 3  for  Kb  we  have : 
or 

Kb  =  -  (4.11) 

V.«t  t* 

For  discrete  time  intervals, 

2C 

Kb  =  -  (4.12) 

Vaat  (NT)  2 

where  T  is  the  sampling  interval  and  N  the  sample  number. 
Letting  C  =  CR, 
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Km  = 


V.at  (NT)  2 


(4.13) 


This  equation  for  Km  is  only  valid  for  the  full  accele¬ 
ration  mode  of  the  motor.  Therefore  we  use  it  until  the 
velocity  of  the  actual  system  reaches  the  velocity  curve  and 
thereafter  we  keep  Km  unchanged  for  the  curve  follow  portion 
of  the  move. 


V.  APPLICATION  OF  THE  CURVE  FOLLOWING  SYSTEM 
FOR  THE  CONTROL  OF  THE  FLEXIBLE  ARM 

The  system  shown  in  Figure  4.10  was  simulated  using 
DSL/VS.  The  simulation  program  derived  for  this  purpose  is 
given  in  Appendix  B.  The  parameters  used  for  this  study  were 
selected  after  exhaustive  simulations  on  a  tri.\l  and  error 
basis.  For  the  gain  constant  Ki  the  best  value  found  was 
0.06.  It  was  found  from  the  simulations  that  any  value  of 
the  gain  constant  KiSl  is  appropriate  for  the  hub  motion  and 
the  higher  the  gain  the  faster  the  positioning  of  the  hub. 
However  as  Ki  is  increased  higher  the  oscillations  that  the 
arm’s  tip  undergoes  also  increase  in  amplitude. 

The  simulation  results  are  shown  in  Figures  5.1  to  5 . 9 
for  values  of  Ki  equal  to  0.7,  0.2  and  0.06  and  for  a  command 
of  0.17  rad  (or  10°).  It  is  clear  that  the  system  follows  the 
velocity  curve,  the  hub  is  positioned  quickly  and  accurately 
but  the  tip  motion  is  unacceptable  for  all  values  of  Ki  .  In 
Figures  5.10  to  5.12  tip  position  and  tip  velocity  were  used 
for  the  velocity  curve  following  system  (in  other  words  the 
loop  was  closed  around  the  tip).  It  is  clearly  3nown  chat,  the 
system  in  this  case  cannot  follow  the  curve  (Figure  5.10)  and 
the  hub  and  tip  motion  are  unstable  (Figures  5.11  and  5.12). 
The  reason  for  that  was  explained  in  Chapter  IV. 
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Figure  5.3  Tip  Motion  With  Ki  =0.7 
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Figure  5.5  Hub  Motion  With  Ki  =0.2 
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.9  Tip  Motion  With  Ki  =  0.06 
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Figure  5.11  Hub  Motion  When  Tip  Position  And  Tip 
Velocity  Are  Used  For  The  Adaptive  Algorithm. 
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Figure  5.12  Tip  Motion  When  Tip  Position  And  Tip 
Velocity  Are  Used  For  The  Adaptive  Algorithm. 
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As  mentioned  previously  the  motion  of  the  arm’s  tip  is 
unacceptable.  This  is  well  explained  physically  if  we 
consider  the  energy  stored  in  the  arm  during  the  whole 
process . 

When  we  give  a  command  to  the  system  to  move  the  hub  to  a 
given  position,  the  position  error  has  its  maximum  value. 
Entering  the  curve  with  this  large  error  we  get  out  a  high 
commanded  velocity  (X) ,  which  enters  the  velocity  loop  and 
drives  the  amplifier  to  its  saturation  limit  and  the  motor 
operates  at  full  forward  acceleration,  supplying  to  the  arm 
the  power  required  for  its  motion. 

The  motion  of  the  hub  starts  immediately  after  the 
application  of  the  torque.  The  motion  of  the  tip,  however, 
undergoes  a  delay  of  about  280  ms.  This  delay  is  seen  in 
Figures  3.6  and  3.8  and  it  is  intuitively  expected.  If  we 
consider  the  arm  as  a  combination  of  springs  and  masses,  some 
energy  is  required  for  the  spring  to  be  "wound-up",  and  only 
when  this  energy  has  been  given,  a  tension  can  arise  at  the 
tip  and  its  motion  will  start.  When  the  tip  starts,  finally, 
moving  the  motor  is  still  in  full  forward  mode  supplying  more 
power,  until  the  error  for  the  hub  position  becomes  negative. 
When  the  hub  reaches  the  commanded  position  the  motor  tries 
to  keep  it  there  switching  from  full  forward  to  full  reverse 
motion  as  necessary.  The  tip  of  the  arm,  on  the  other  hand, 
does  not  stop  but  continues  its  motion,  under  the  stored 
energy  in  the  spring.  The  motion  of  the  tip  ceases  only  when 
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the  physical  deunping  of  the  arm  dissipates  all  the  stored 
energy  in  the  spring. 

The  arm,  however,  is  very  flexible  and  its  damping  is 
very  low  and  takes  a  long  time  to  dissipate  the  energy  stored 
during  the  process  and  this  is  why  we  have  so  long  lasting 
oscillations  as  seen  from  Figures  5.3,  5.6  and  5.9. 

We  also  see  from  these  figures  that  the  higher  the  gain 
constant  Ki  the  longer  the  tip’ s  oscillations  and  the  higher 
the  overshoot.  This  happens  because  when  high  gains  are  used, 
the  system  puts  more  energy  into  the  arm. 

At  this  point  someone  could  expect  that  when  the  motor 
reverses ,  it  would  take  out  the  energy  stored  into  the 
system.  This  does  not  happen  for  the  following  reason:  When 
the  hub's  velocity  reaches  the  curve  (commanded  velocity), 
the  system  "tries"  to  follow  it,  switching  the  amplifier 
between  the  positive  and  the  negative  limits.  The  tip  s 
oscillations,  on  the  other  hand,  are  reflected  back  to  the 
hub,  where  the  system  senses  them  and  they  are  another  reason 
that  causes  this  continuous  switching  of  the  amplifier.  This 
switching  results  in  a  fixed  position  of  the  hub  and  good 
curve  tracking,  but  it  makes  the  average  energy  given  to  or 
taken  out  of  the  arm  to  be  almost  equal  to  aero.  Therefore 
the  reverse  motion  of  the  motor  does  not  absorb  any  energy 
from  the  arm.  The  torque  applied  to  the  arm,  with  the  hub 
motion  superimposed  is  shown  in  Figure  5.13.  We  clearly  see 
the  fast  switching  of  the  torque  after  the  hub’s  velocity  has 
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reached  the  curve.  This  continued  switching  stops  for  s  while 
when  the  hub  reaches  the  commanded  position  in  order  to 
prevent  a  motion  to  the  opposite  direction. 

Another  observation  drawn  from  the  tip’s  motion  is  that 
the  arm  is  extremely  flexible.  There  is  no  engineering  reason 
for  using  such  an  arm  in  a  practical  application.  Actually 
the  arm  is  about  100  times  more  flexible  than  a  practical 
one,  [Ref.  1].  Therefore  if  we  had  used  a  "practical  flexible 
arm"  with  the  above  control  scheme,  its  performance  would 
have  been  10  times  better. 

It  is  clear  from  the  above  considerations  that  we  must 
find  some  way  to  remove  the  energy  out  of  the  system,  in 
order  to  make  the  tip  motion  acceptable.  In  the  next  chapter 
four  different  methods  will  be  used  for  the  solution  of  this 
problem.  In  the  first  method  a  simple  cascade  compensator 
will  be  used  for  the  final  motion  of  the  arm.  In  the  second 
method  an  attempt  to  reduce  the  energy  given  to  the  arm  will 
be  made  by  shaping  the  input  command.  In  the  third  method  we 
will  use  poai-cast  control.  Finally  as  a  last  resort  a 
complex  feedback  compensator  based  on  optimal  control  theory 
will  be  used. 


I. 


CONTROL  OF 


THE  TIP  OF  T1 


A.  USE  OF  A  SIMPLE  COMPENSATOR 

As  mentioned  in  Chapter  V  some  way  must  be  found  to 
remove  the  energy  stored  in  the  arm,  in  order  to  make  the 
tip’s  motion  acceptable.  As  a  first  attempt  to  solve  this 
problem,  a  simple  compensator  will  be  used.  The  resulting 
control  scheme  is  shown  in  Figure  6.1.  The  arm  is  driven  by 
the  curve  following  system  until  a  specific  point  off  the 
final  position  is  reached.  Then  we  switch  to  the  linear 
regulator,  switching  off  the  curve  following  system,  for  the 
final  motion  of  the  arm,  by  changing  the  position  of  the 
switch  SW1.  The  compensator  that  will  be  used  in  the  linear 
regulator  must  be  designed  in  such  a  way  that  it  can  provide 
sufficient  damping  in  order  to  dissipate  the  energy  stored  in 
the  arm.  If  we  consider  the  frequency  response  of  the  arm 
(Figures  3.1  and  3.2)  we  can  see  that  this  is  not  an 
easy  task. 

As  we  see  from  Figure  6.1  the  linear  regulator  is  a 
closed  loop  system,  with  feedback  signal  from  the  tip 
position  of  the  arm. 

The  cascade  compensator  used  in  this  linear  system  was 
derived  using  classical  control  techniques  (frequency 
response  method),  on  a  trial  and  error  basis.  The  ultimate 
task  of  the  trials  was  to  obtain  the  largest  possible  phase 
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margin  for  the  open  loop  system,  which  would  correspond  to  a 
large  overall  damping  coefficient.  Furthermore  this 
compensator  should  be  kept  as  simple  as  possible  in  order  to 
be  easily  implemented  in  a  microprocessor. 

The  resulted  compensator  consists  of  two  filters.  One 
phase  lead  filter  and  a  second  order  filter  with  complex 
poles.  The  transfer  function  of  the  phase  lead  filter  is: 

0.5S  +  0.25 

G1  =  -  ,6.1) 

0.5S  +  1 

The  transfer  function  of  the  second  order  filter  is: 

16 

62  =  -  6  2 

Sa  +  1.6S  +16 

The  open  loop  frequency  response  of  the  linear  regulator 
is  shown  in  Figure  6.2,  and  the  step  response  of  the  closed 
system  in  Figures  6.3  and  5.4,  for  the  hub  and  tip  motion 
respectively. 

From  Figure  6.2  we  see  that  the  phase  margin  is  42*. 
which  corresponds  to  a  damping  coefficient  of  about  04  This 
is  not  a  high  damping  and  as  seen  in  Figures  63  and  64.  the 
resulting  overshoot,  for  the  tip  motion.  .j  it  me  rier  r 
45S  and  the  settling  time  very  5  sec  "hese  resu.-s 

are  not  acceptable  for  the  motion  of  a  robot  arm  where  we 
strive  for  speed  end  accuracy 

Nevertheless  the  system  is  studied  for  various  reasons 
First  it  is  very  simple.  Secondly  we  can  have  a  baseline  of 
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Figure  6.4  Step  Response  Of  The  Linear  System  (Tip  Motion) 
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performance  for  future  alternatives.  Finally  this  system  can 
be  proven  appropriate  for  the  case  where  the  arm  is  not  so 
extremely  flexible. 

The  resulting  combination  of  the  curve  following  and  the 
linear  regulator,  shown  in  Figure  6.1,  was  simulated  using 
the  DSL/VS  program  listed  in  Appendix  C.  The  results  of  the 
simulations  are  shown  in  Figures  6.5  through  6.6,  where 
different  switching  points,  from  the  curve  following  to  the 
linear  system  have  been  used.  We  see  that  no  matter  at  what 
point  we  make  the  switching  to  the  linear  mode,  the  arm  (hub 
and  tip)  undergoes  a  large  overshoot  before  it  settles  down 
to  the  commanded  position. 

It  is  obvious  that  this  scheme  does  not  work  at  least  for 
the  case  of  the  very  flexible  arm. 


B.  POSI-CAST  CONTROL 

As  a  second  attempt  to  control  the  arm’s  tip  we  will  use 
posi-cast  control. 

The  basic  idea  behind  this  scheme  is  very  simple.  Let’s 
consider  a  system  whose  overshoot  to  a  step  input  is  known 
(from  previous  simulations  or  tests).  Instead  of  applying  the 
desired  command  to  the  system  at  once,  we  can  apply  it  in  two 
or  more  specified  steps.  The  rule  that  is  used  to  determine 
the  steps,  for  the  case  where  only  two  steps  are  used  is  the 
following:  We  apply  the  first  fraction  of  the  command,  whose 
magnitude  is  calculated  in  such  a  way  that  at  the  peak 
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overshoot,  the  output  of  the  sjrstea  is  equal  to  the  desired 
final  position.  When  the  output  is  at  its  peak,  we  add  to  the 
input  the  second  fraction  of  the  command.  When  this  new  input 
is  seen  by  the  system,  the  position  error  is  zero,  and  the 
system’s  output  stays  at  its  overshoot  value  obtained  by  the 
first  fraction  of  the  command.  The  result  is  no  overshoot  at 
all  and  the  settling  time  is  considerably  reduced. 

Now  in  the  case  of  the  flexible  arm  this  scheme  might 
possibly  work.  If  we  imagine  the  arm  as  a  circular  spring, 
the  energy  is  stored  into  the  arm  by  winding  that  spring. 
When  the  tip  reaches  its  maximum  position,  it  reverses 
velocity  and  moves  in  the  opposite  direction.  This  motion 
unwinds  the  spring  and  through  the  spring’s  damping  the 
energy  stored  in  the  arm  is  dissipated  and  the  tip  settles 
down. 

When  the  tip  is  at  its  peak  overshoot  position,  we  can 
slow  down  (or  hopefully  stop)  its  motion,  towards  the 
opposite  direction,  if  we  find  a  way  to  unwind  the  spring. 
This  can  be  accomplished  by  moving  the  hub  towards  the 
direction  of  the  tip.  Therefore,  if  we  apply  a  predetermined 
input,  so  that  the  arm’s  tip  overshooting  reaches  the  desired 
position,  and  then  add  to  the  input  the  second  fraction  of 
tne  command,  we  can  unwind  the  "spring''  and  hopefully  make 
the  motion  of  the  tip  acceptable. 

Another  factor  that  we  have  to  consider,  is  the  delay 
that  the  tip’s  motion  undergoes.  It  may  possibly  be  necessary 
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to  apply  tha  second  fraction  of  -.ha  input  i  little  bit 
aarliar  than  tha  time  that  corraaponds  to  tha  paak  overshoot 

Tha  D6L/VS  program  shown  in  Appandix  D  was  uaad  for  tha 
simulation  of  this  idea  and  tha  results  are  snown  in  Figures 
6.9  to  6.12  for  different  times  of  application  of  the  sacond 
fraction  of  the  desired  command.  We  see  that  wnen  tne  3e*sy 
of  the  tip’s  response  (280  msec)  is  taken  into  account 
(Figure  6.12),  the  motion  of  the  tip  is  satisfactory,  while 
the  hub’s  motion  is  always  very  good  (Figures  6.9  and  6  lit. 
Comparing  Figure  6.10  with  Figure  6.12  we  see  how  critical 
is  the  time  of  the  application  of  the  second  portion  of  the 
input  command.  The  optimal  point  of  application  of  the  second 
portion  of  the  input  cannot  be  found  very  accurately,  and  it 
changes  with  the  operation  conditions  (load,  speed,  magnitude 
of  the  input,  etc.).  Therefore  we  do  not  expect  so  much  from 
this  control  scheme,  for  a  real  application. 

C.  USE  OF  A  SHAPED  INPUT 

It  is  seen  from  the  motion  of  the  tip,  that  at  the 
beginning  of  the  application  of  the  torque,  there  is  energy 
given  to  the  arm,  without  any  motion  of  the  tip.  When  this 
energy  winds  the  'spring',  the  tip  starts  moving  first  m  tne 
opposite  direction,  and  then  quickly  towards  the  desired 
direction  (Figures  5.3,  5.6  and  5.9). 

The  energy  supplied  to  the  arm  depends  on  the  magnitude 
of  the  input  command.  If,  therefore,  we  shape  the  input 


YT  ( 1 0- »  METERS) 


86 


■ 


TIME  (SEC) 


Figure  6.12  Posi-Cast  Control  (Tip  Motion) , Taking  Into 
Account  The  280  msec  Delay  Of  The  Tip’s  Response. 


coaund.  so  that  only  *  small  uiount  of  energy  is  supplied  to 
tha  arm.  during  this  early  stags  of  the  motion.  it  seems 
reasonable  to  assume  that  a  better  motion  of  the  tip  will 
result 

For  thia  purpose  the  input  shape  anown  in  Figure  6  1  J  was 
used  This  shaped  command  has  been  found  in  Chapter  IV 
i Figures  4.7,  4.6  and  46)  to  give  good  results  when  used  as 
an  input  to  the  curve  following  system  The  resulting 
motion  of  the  hub  and  the  tip  of  the  arm  are  shown  in  Figures 
d  14  snd  d  15  respectively  Again  we  see  that  the  resulting 
motion  of  the  tip  is  not  acceptable. 

The  input  shape  used  is  of  course  a  very  simple  me  and 
someone  could  expect  that  a  different  shape  could  probably 
give  better  results.  Thia  may  be  true,  but  it  is  also  true 
that  this  different  input  shape  may  require  complicated  and 
time-consuming  calculations ,  resulting  in  a  complex  system 
The  most  systematic  way  to  calculate  the  appropriate  input 
shape  is  by  the  application  of  optimal  control  theory.  The 
optimal  input  is  then  found  as  the  one  that  minimizes  the 
selected  cost  function. 

In  this  and  the  previous  sections  we  made  use  of  various 
junpio  schemes  for  the  control  of  the  tip  of  tae  arm.  <fe 
found  tnat  none  of  them  gave  satisfactory  results,  and  we 
must  have  been  convinced  by  now  that  we  have  to  use  more 
complex  schemes  in  order  to  control  the  motion  of  the  tip. 
However  we  must  always  keep  in  mind,  that  the  arm  used  with 
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Figure  6.13  Input  Shape  For  The  Motions  Shown 
In  Figures  6.14  And  6.15 
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Figure  6.14  Hub  Motion  Subject  To  The  Input 
Shown  In  Figure  6.13. 
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Figure  6.15  Tip  Motion  Subject  To  The  Input 
Shown  In  Figure  6.13. 


the  previous  schemes  is  a  very  flexible  one.  It  is  possible 
that  some  of  the  tested  ideas  may  work  satisfactorily  when  we 
use  them  for  the  control  of  a  stiffer  arm. 

D.  FEEDBACK  COMPENSATION 
1.  Overview 

As  already  mentioned  all  the  attempts  made  to  control 
the  tip  of  the  arm  by  simple  methods  had  no  success.  None  of 
the  previous  methods  provided  the  necessary  damping  to 
dissipate,  in  a  reasonable  time,  the  energy  stored  in  the 
arm.  Therefore  we  have  to  consider  the  application  of  more 
complex  schemes. 

In  this  section  a  feedback  compensator,  whose  design 
is  based  on  optimal  control  theory,  will  be  used.  This 
compensator  is  given  in  [Ref.  13.  The  curve  following  scheme 
will  be  used  in  order  to  drive  the  arm  quickly,  over  a  large 
portion  of  the  whole  motion.  Then  we  will  switch  off  the 
curve  following  scheme,  and  we  will  leave  the  rest  of  the 
motion  to  be  done  under  the  linear  regulator.  This  composite 
scheme  offers  a  significant  advantage,  compared  with  the 
scheme  used  in  [Ref.  1].  In  [Ref.  1],  the  control  of  the  arm 
is  done  by  using  only  the  linear  system.  Attention,  however, 
has  to  be  paid,  in  order  to  avoid  driving  the  motor  to 
saturation.  If  this  happens  the  whole  system  is  rendered 
inappropriate.  To  avoid  this  problem,  [Ref.  1]  uses  only 
small  displacements  as  inputs  to  the  system.  If  a  large 
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displacement  is  desired,  it  has  to  be  applied  through  a 
number  of  smaller  movements,  resulting  in  large  total  time. 

When  we  use  the  composite  s/stem.  shown  in  Figure 
6.16,  the  saturation  of  the  motor  is  not  a  problem  an y  more. 
The  first  stage  of  the  motion,  where  large  torques  are 
required  due  to  the  large  position  error,  is  done  by  the 
curve  following  scheme,  without  worrying  about  the  saturation 
of  the  motor.  When  the  position  error  becomes  small  and 
therefore  only  small  torques  are  required,  we  switch  to  the 
linear  mode,  which  provides  the  necessary  damping,  to  remove 
the  energy  stored  into  the  arm  and  make  the  motion  of  the  tip 
acceptable. 

2.  Design  Of  The  Feedback  Compensator 

First  of  all  we  have  to  decide  which  signal  we  will 
feed  back  for  the  compensation  of  the  system.  If  we  use  as  a 
feedback  signal  the  hub  position  or  the  hub  velocity,  we  will 
loose  all  the  information  about  the  tip,  because  the  tip  does 
not  follow  the  hub  motion,  as  in  the  case  of  a  rigid  arm. 
Therefore  we  have  to  use  tip  feedback  for  the  compensation  of 
the  system.  To  use  tip  feedback  however,  we  need  a  sensor  to 
measure  the  position  of  the  tip.  To  build  such  a  sensor  is  by 
no  means  a  trivial  problem,  and  extensive  research  has  to  oe 
done  on  this  area. 

For  the  purpose  of  this  thesis  we  will  assume  that 
such  a  sensor  exists,  which  gives  us  accurate  measurements 
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of  the  position  of  the  tip.  With  this  provision  we  can  now 
proceed  in  the  design  of  the  feedback  compensator. 

The  design  of  the  compensator  is  given  in  chapter 
five  of  [Ref.  1].  At  first  a  full  state  feedback  regulator  is 
designed,  which  minimizes  the  cost  function: 

J  -  J"  (XT  Ac  X  +  uT  Bu)  dt, 

where  X  is  the  state  of  the  system  and  u  the  input  to  the 
system. 

Consequently  a  state  estimator  is  designed  in  orcer 
to  provide  the  states  of  the  system,  used  by  the  regulator 

Three  different  compensators  have  been  designee  n» 
uses  only  tip  position  feedback.  The  second  uses  tip  pcs;‘; 
and  hub  velocity,  while  the  third  uses  tip  position,  hut- 
velocity  and  strain-gauge  as  feedback  signals. 

The  latter  two  yield  better  results  but  *hev 
complex  and  it  is  questioned  whether  or  not  they  can  he  .«» 
in  a  practical  application.  In  order  to  keep  our  sv«*«"  * 
simple  as  possible,  we  will  use  the  first  compensa*  »  w 
is  the  simplest  one.  Its  transfer  function  is 
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exactly  at  the  frequencies  of  the  first  and  the  second 
vibration  mode  of  the  arm.  This  makes  the  closed  loop  system 
very  sensitive  to  errors  or  changes  of  the  vibration 
frequencies.  Especially  in  the  case  of  the  loaded  arm,  where 
the  vibration  frequencies  are  moved  to  the  left  by  0 . 4 
rad/sec  (Figures  3.3  and  3.4)  we  are  going  to  face  problems. 
The  step  response  of  the  closed  loop  linear  system  is  shown 
in  Figure  6.17,  where  we  see  a  very  well  damped  motion  of  the 
tip  of  the  arm,  with  zero  overshoot. 

3.  Simulation  Of  The  System 

The  composite  system  shown  in  Figure  6.16  was 
simulated  by  the  DSL/VS  program  listed  in  Appendix  S. 
Different  values  for  the  gain  constant  K l  and  various  points 
for  the  switching  from  the  curve  following  to  the  linear 
system  were  used.  The  results  of  these  simulations  are  shown 
in  Figures  6.18  to  6.25.  The  Figures  6.18  through  6.23 
correspond  to  a  small  commanded  position  equal  to  0.17  rad 
(or  10°).  The  Figures  6.24  and  6.25  correspond  to  a  commanded 
position  equal  to  one  radian  (large  motion).  From  these 
simulations  (and  even  more  not  included),  the  best  value 
found  for  Ki  was  0.06.  The  resulting  system  is  very  good  for 
the  control  of  the  tip  when  "large  motion"  is  used.  When  the 
motion  is  "small"  we  obtain  almost  the  same  settling  time  as 
when  we  use  the  linear  system  alone,  but  we  have  an  overshoot 
of  the  order  of  7%  (for  Ki  =0.06).  This  overshoot  may  or  may 
not  be  acceptable,  depending  on  the  specific  application. 
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Figure  6.18  Hub  Motion  Using  The  System  Shown  In  Figure  6.16 

With  Ki  =0.2  (Small  Motion). 
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Figure  6.19  Tip  Motion  Using  The  System  Shown  In  Figure  6.16 

With  Ki  =  0.2  (Small  Motion). 


Figure  6.20  Hub  Motion  Using  The  System  Shown  In  Figure  6.16 
With  Ki  =0.08  (Small  Motion). 
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Figure  6.21  Tip  Motion  Using  The  System  Shown  In  Figure  6.16 
With  Ki  =0.06  (Small  Motion). 
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Figure  6.22  Hub  Motion  Using  The  System  Shown  In  Figure  6.16 
With  Ki  =  0.06  (Small  Motion). 

102 


< 

J 

•I 


! 

I 


Figure  6.23  Tip  Motion  Using  The  System  Shown  In  Figure  6.16 
With  Ki  =0.06  (Small  Motion). 
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Nevertheless,  when  the  displacement  is  "small",  there  is  no 
need  to  use  the  curve  following  scheme  at  all,  because  in 
this  case  there  is  no  saturation  problem  for  the  motor. 
Therefore,  we  can  use  the  system  shown  in  Figure  6.16  for  all 
applications,  taking  care  to  avoid  the  use  of  the  curve 
following  mode,  when  the  commanded  position  is  relatively 
small  (of  the  order  of  5*  to  10°). 
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VII. 


A.  INTRODUCTION 

In  the  preceding  chapters  the  control  of  a  very  flexible 
arm  was  studied,  and  we  found  that  the  most  effective  control 
scheme  was  the  one  given  in  section  D  of  Chapter  VI. 

The  use  of  a  very  flexible  arm  made  the  problem 
relatively  difficult  and  from  a  theoretical  point  of  view,  it 
was  a  very  good  test  for  the  various  systems  used.  Due  to  the 
extremely  high  flexibility  of  the  arm,  we  had  to  use  the  most 
complex  and  most  demanding  control  scheme,  whose  design  was 
based  on  optimal  control  theory.  All  simpler  control  schemes 
were  found  to  be  inappropriate  for  the  control  of  the  arm. 

However  as  mentioned  in  earlier  chapter,  the  arm  used  is 
100  times  more  flexible  than  a  "practical  flexible"  arm.  It 
is  therefore  necessary  to  test  our  techniques  on  the  case  of 
that  practical  arm,  and  see  if  it  is  still  necessary  to 
employ  such  complex  control  schemes . 

In  the  following  the  stiffness  of  the  arm  will  be 
increased  eventually.  For  each  case  the  curve  following 
system  will  be  used,  in  order  to  see  whether  or  not  it  can 
work  effectively.  When  we  arrive  to  the  "practical  flexible" 
arm  (100  times  stiffer),  a  simple  linear  regulator  will  be 


107 


used  in  combination  with  the  velocity  curve  following  system, 
for  the  final  motion  of  the  arm. 

B.  BASIC  THEORY  OF  ELASTICITY 

Before  we  actually  attempt  to  change  the  stiffness  of  the 
arm,  it  is  considered  necessary  to  have  some  understanding  of 
what  elasticity  (or  stiffness)  means,  and  the  basic  physics 
behind  it. 

The  measure  of  the  stiffness  of  a  material  is  given  by 
the  modulus  of  elasticity  or  the  Young’s  modulus,  E.  This 
modulus  describes  the  elastic  deformation  of  a  material 
subject  to  an  applied  stress.  It  tells  us  what  stress  we  have 
to  apply  to  the  material  in  order  to  obtain  a  desired 
deformation,  as  long  as  the  material  is  in  its  elastic  region 
and  has  not  plastically  deformed.  The  higher  the  value  of  the 
Young’s  modulus  the  higher  the  stiffness  of  the  material.  The 
modulus  of  elasticity  is  related  to  the  forces  bonding  the 
atoms  in  the  material,  and  it  is  a  property  of  each  material. 
These  bonding  forces  are  higher  for  high  density  and  high 
melting  point  materials. 

Some  indicative  values  of  the  modulus  of  elasticity  are: 


Magnesium 

(Mg) 

(6. 5)(1O)0 

psi 

Aluminum 

(Al) 

( 10)  ( 10  )« 

psi 

Iron 

(Fe) 

( 30 ) ( 10 )® 

psi 

Tungsten 

(W) 

(58.9X10)® 

psi 

We  see  that  the  modulus  of  elasticity  varies  over  a  large 
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range.  The  above  values  of  E  refer  to  pure  metals.  There 
exist  many  alloys  with  much  higher  E  than  the  given  values. 

For  the  above  materials  the  corresponding  densities  are 
as  follows: 


Magnesium 

(Mg) 

1.74 

g/cm* 

Aluminum 

(Al) 

2.9 

g/cm* 

Iron 

(Fe) 

7.91 

g/cm* 

Tungsten 

(W) 

19.25 

g/cm® 

If  we  compare  the  modulus  of  elasticity  ratios,  between 
these  materials  with  the  density  ratios  of  the  same 
materials,  we  find  that  they  are  almost  equal.  This  means 
that  the  weight  of  a  fixed  size  block  of  material  (like  an 
arm  in  our  case),  increases  linearly  with  the  modulus  of 
elasticity. 

From  this  result  we  see  that  a  50  times  increase  of  the 
stiffness  of  the  arm,  means  an  increase  of  its  weight  by 
almost  the  same  factor.  This  is  not  a  favorable  result,  if  we 
consider  that  in  order  to  have  a  "practical  flexible"  arm,  we 
must  increase  the  stiffness,  of  the  original  arm,  by  a  factor 
of  100. 

Nevertheless ,  we  can  avoid  the  excess  weight  introduced 
by  the  change  of  the  stiffness,  by  choosing  appropriate 
geometrical  shapes  for  the  arm.  For  example,  in  the  arm  used 
in  [Ref.  1],  flexibility  across  the  vertical  plane  was 
avoided  by  constructing  the  arm  as  a  combination  of  two 
series  of  parallel  vertical  plates.  If  we  were  to  place  a 
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third  series  of  plates,  horizontally,  between  the  two 
vertical  ones,  so  that  the  final  cross  section  of  the  ana  was 
as  the  letter  *‘H" ,  we  could  increase  the  stiffness  of  the  arm 
across  the  horizontal  plane,  without  introducing  so  much 
weight.  Depending  on  the  motion  the  arm  is  designed  to 
perform,  in  a  real  situation,  a  variety  of  geometrical  shapes 
can  be  used,  to  reduce  the  flexibility  of  the  arm  in  the 
direction  of  motion,  and  keep  its  weight  as  low  as  possible. 
It  is  therefore,  not  impractical  to  talk  about  stiffness 
reduction,  since  this  does  not  necessarily  mean  an  analogous 
weight  increase.  Having  realized  this  fact  we  can  now  start 
changing  the  stiffness  of  the  arm,  and  perform  the  tests  for 
the  curve  following  system,  in  each  case. 

C.  CHANGE  OF  THE  STIFFNESS  OF  THE  ARM 

The  stiffness  of  the  arm  will  be  eventually  increased 
until  we  reach  the  100  times  stiffer  arm,  which  is  considered 
to  be  a  practical  one.  Intermediate  stiffness  will  be  used  in 
order  to  see  more  clearly  what  is  going  on  and  how  the 
stiffness  affects  the  overall  control  scheme.  Three  different 
stiffness  will  be  used.  Namely,  20  times,  50  times  and  100 
times  stiffer  arms. 

In  Chapter  II  the  mathematical  model  of  the  very  flexible 
arm  is  given.  [Ref.  1]  states  that  the  zeros  and  the  complex 
poles  of  the  transfer  functions  are  proportional  to  the 
square  root  of  the  Young’s  modulus  E.  In  order,  therefore  to 

110 


change  the  stiffness  of  the  arm,  we  have  to  multiply  all 
zeros  and  the  complex  poles,  by  the  square  root  of  the  factor 
by  which  the  stiffness  is  to  be  changed.  Doing  that  the 
following  transfer  functions  for  the  various  stiffness 
result: 

20  times  stiffer  arm  -  Hub  transfer  function: 

0(s)  46 . 321 ( s+0 . 49± jl4 . 94)(s+1.3±j78.13)( s+3 . 9± j207 . 69) 

T(s)  s(s+0.2)(s+0.76±j52.73)(s+1.79±j96.64)(s+3.22±j214.9) 

20  times  stiffer  arm  -  Tip  transfer  function: 

Yt (s)  -2. 177(s-53.84 )(s+54. 3) (s+100. I±jl08. 23) (s-96. 24± jll3) 

T(s )  s( s+0 . 2 ) ( s+0 . 76± j52 . 73) ( s+1 . 79± J96 . 64 ) ( s+3 . 22± j214 . 9) 

50  times  stiffer  arm  -  Hub  transfer  function: 

0(s)  46 . 321 ( s+4 . 88± j328 . 38 ) ( s+2 .05±jl23.5)( s+0 . 78± j23 . 62 ) 

T(s)  s(s+0 .2)(s+1.2±j83.37)( s+2 .83±jl52.8)(s+5. 1± J339 . 9 ) 

50  times  stiffer  arm  -  Tip  transfer  function: 

Yt (s)  -2.177(s-85,l)(s+85.8)(s+158.3±jl71.1)(s+152.2±jl78.9) 

T(s)  s( s+0 .2)(s+1.2±j83.37)(s+2.83±jl52.8)(s+5.1±j339.9) 

100  times  stiffer  arm  -  Hub  transfer  function: 

0(s)  46.321(s+l. I±j33. 4) (s+2. 9±jl74. 7) (s+6.9±j464. 4) 

T(s)  s (s+0 .2)(s+1.7±jll7.9)( s+4± j216 . 1 ) ( s+7 . 2±j480 . 7 ) 

100  times  stiffer  arm  -  Tip  transfer  function: 
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Yt (s)  -2. 177(a-120. 4) (s+121. 4) (s+223. 8±j242) (s-215. 2± j253) 
T(s)  s(  s+0 .2)(s+1.7±jll7.9)(  s+4± j216 . 1 )  ( s+7 . 2± j480 . 7 ) 

D.  BASIC  STUDIES  OF  THE  STIFFER  ARMS 

Aa  in  Chapter  II  we  again  preaent  here  the  results  of 
some  preliminary  studies  on  the  arms  with  different 
stiffness.  These  studies  are  intended  to  quantify  our  results 
and  to  reveal  the  basic  characteristics  of  the  arms.  Also  we 
will  use  them  for  the  design  of  the  linear  regulator,  that 
will  be  used  in  the  case  of  the  100  times  stiffer  arm. 

The  results  of  these  basic  studies  are  shown  in  Figures 
7.1  through  7.12  and  they  consist  of  the  frequency  and  step 
response  of  each  arm.  For  the  derivation  of  these  graphs  the 
software  package  "CONTROLS"  was  used. 

From  comparison  of  the  frequency  response  for  each  case, 
we  see  that  the  resonant  frequencies  are  moving  to  the  higher 
values  by  a  factor  equal  to  the  square  root  of  the  factor  by 
which  the  stiffness  has  been  changed,  as  it  was  expected. 

In  the  step  response  graphs  we  see  the  reduction  of  the 
oscillations  as  the  stiffness  is  increased.  In  the  tip’s  step 
response  we  still  have  a  delay  in  the  response  of  the  tip  of 
the  arm  of  the  order  of  300  msec.  Thereafter  the  tip  moves 
initially  towards  the  opposite  direction  than  the  desired  and 
then  it  starts  the  desired  motion. 

It  is  clear  that  the  arm  maintains  all  the  characteristic 
properties  of  the  very  flexible  arm,  even  the  most  stiff  one. 
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Figure  7.2  Open  Loop  Bode  Plot  Of  The  Tip  Transfer  Function 

Of  The  20  Times  Stiffer  Arm. 


Figure  7.3  Step  Response  Of  The  Hub  Transfer  Function  Of  The 

20  Tines  Stiffer  Arm. 
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Figure  7.7  Step  Response  Of  The  Hub  Transfer  Function  Of  The 

50  Times  Stiffer  Arm. 
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Figure  7.12  Step  Response  Of  The  Tip  Transfer  Function  Of 

100  Tines  Stiffer  Arm. 
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The  only  difference  is  that  the  intensity  of  these  properties 
is  being  reduced  as  the  stiffness  is  increased. 

E.  DSE  OF  THE  CURVE  FOLLOWING  SCHEME  WITH  THE  STIFFER  ARMS 

The  curve  following  scheme  shown  in  Figure  4.10  was 
simulated  using  the  DSL/VS  programs  shown  in  Appendices  F 
through  H  with  an  arm  of  different  stiffness  in  each  case. 
The  corresponding  Hub  and  Tip  motion  for  each  case  are  shown 
in  Figures  7.13  to  7.18.  The  time  scale  was  intentionally 
left  the  same  for  all  those  figures  in  order  to  see  more 
easily  the  resulting  difference  in  the  performance  of  the 
curve  following  system,  as  the  stiffness  of  the  arm  is 
increased.  For  a  more  complete  picture,  the  results  presented 
in  Figures  7.13  to  7.18  should  be  compared  with  Figures  5.8 
and  5.9.  From  that  comparison  we  see  that  the  motion  of  the 
Hub  is  always  excellent  and  is  not  affected  by  the  change  of 
the  stiffness  of  the  arm.  The  motion  of  the  Tip,  however,  is 
dramatically  improved  as  the  arm  is  getting  stiffer  and 
stiffer.  Especially  in  the  case  of  the  100  times  stiffer  arm, 
the  motion  of  the  Tip  is  very  nice  and  better  than  the  motion 
shown  in  Figure  6.23  where  the  state  feedback  compensator  was 
used  for  the  final  motion. 

This  is  an  encouraging  result  and  indicates  that  the 
curve  following  system,  whose  advantages  were  outlined  in 
Chapter  IV,  can  be  effectively  used  for  the  control  of  a 
"practical  flexible"  arm. 


Figure  7.16  Tip  Motion  Of  The  50  Times  Stiff er  Arm  Using 

The  Curve  Following  System. 
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F.  LINEAR  COMPENSATOR  DESIGN  FOR  THE  FINAL  MOTION  OF  THE 

100  TIMES  STIFFER  ARM 

In  section  D  of  Chapter  VI  a  state  feedback  compensator 
was  used  for  the  final  motion  of  the  very  flexible  arm.  That 
compensator  provided  high  damping  so  that  the  energy  stored 
in  the  arm  was  dissipated,  resulting  in  a  good  motion  of  the 
Tip  of  the  arm. 

In  the  case  of  the  "practical  flexible"  arm,  its  natural 
damping  is  high  enough,  that  dissipates  the  energy  provided 
to  the  arm  quickly,  and  the  arm  becomes  more  “controllable". 
However  we  need  again  a  linear  regulator  for  the  final  motion 
of  the  arm.  Its  purpose  is  not  to  provide  damping  to  the 
system,  but  to  switch  off  the  curve  following  system  and 
drive  to  zero  any  small  remaining  error. 

As  was  explained  in  Chapter  VI,  the  Tip  position  is  the 
best  feedback  signal  to  be  used  with  the  linear  regulator  (in 
other  words  the  loop  of  the  linear  system  will  be  closed 
around  the  Tip). 

The  problem  of  designing  the  appropriate  linear  system  in 
the  case  of  the  100  times  stiffer  arm,  is  not  difficult, 
since  the  resonant  frequencies  have  now  been  moved  to  higher 
values  as  shown  on  Figure  7.10. 

Classical  control  methods  were  employed  for  the  design  of 
the  compensator  to  be  used  with  the  linear  system  for  the 
final  motion.  The  ultimate  task  of  the  design  was  to  obtain 
the  largest  possible  phase  margin  and  the  highest  crossover 
frequency.  After  a  trial-and-error  process  it  was  found  that 
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the  most  effective  compensator  consists  of  two  filters.  One 
phase  lead  filter,  whose  transfer  function  is: 

2s  +  1 

01(a)  =  - 

0.005s  +1 

The  second  filter  is  a  second  order  filter  with  transfer 
function : 

1600 

G2 ( s )  =  - 

s2  +  72s  +  1600 

These  two  filters  were  connected  in  cascade  with  the 
system,  in  a  fashion  similar  to  that  shown  in  Figure  6.1.  The 
arm  will  be  first  driven  by  the  curve  following  system.  When 
it  reaches  the  commanded  position  the  curve  following  system 
will  be  switched  off  and  the  arm  will  be  left  under  the 
control  of  the  linear  regulator. 

In  the  following  the  simulation  results  are  presented. 
First,  in  Figure  7.19  the  open  loop  Bode  plot  of  the 
compensated  linear  system  is  shown.  The  phase  margin  is  73° 
and  the  crossover  frequency  4  rad/sec.  This  phase  margin 
corresponds  approximately  to  a  damping  of  0.7,  which  is 
consider  to  be  sufficient  to  keep  the  overshoot  as  low  as 
possible.  In  Figure  7.20  the  step  response  of  the  linear 
system  is  shown  (tip  motion).  The  motion  of  the  tip  is  well 
damped  and  the  overshoot  is  of  the  order  of  4%.  Finally  in 
Figures  7.21  and  7.22,  we  see  the  resulting  hub  and  tip 

133 


•AMAI 


135 


CR  (1 


TIME  (SEC) 


Figure  7.22  Tip  Motion  Using  The  Linear  System  For  The 

Final  Motion. 
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motion  from  the  simulation  of  the  system  shown  in  Figure  6.1, 
where  the  appropriate  transfer  functions  derived  above  have 
been  substituted.  The  DSL/VS  program  used  for  this  simulation 
is  given  in  Appendix  I.  From  Figure  7.22  we  see  that  the 
motion  of  the  tip  is  excellent  and  the  oscillations  that  are 
shown  in  Figure  7.18,  where  the  curve  following  system  was 
used  alone,  have  been  completely  eliminated. 

This  result  leads  us  to  the  conclusion  that  the  curve 
following  system  with  the  aid  of  a  simple  linear  regulator, 
can  be  very  effectively  used  for  the  control  of  a  "practical 
flexible"  arm. 


138 


IIX.  FLEXIBLE  ARM  WITH  TIP  LOAD 


A.  OVERVIEW 

In  the  preceding  chapters,  we  studied  in  detail  the  case 
of  an  unloaded  arm.  We  started  with  a  very  flexible  arm,  and 
we  applied  numerous  techniques  for  its  control.  We  saw  that 
the  problem  is  by  no  means  trivial ,  and  the  employment  of  a 
very  flexible  control  scheme,  in  section  D  of  Chapter  VI,  was 
necessary,  in  order  to  achieve  an  acceptable  motion  of  the 
tip  of  the  arm. 

Consequently  the  stiffness  of  the  arm  was  changed,  until 
we  reached  the  100  times  stiffer  arm,  which  is  considered  as 
a  "practical  flexible"  arm.  The  control  problem  in  that  case 
was  easier  and  the  curve  following  system,  with  the  aid  of  a 
very  simple  linear  regulator,  was  sufficient  to  give  us  very 
good  results . 

The  story,  however,  does  not  stop  here.  A  big  step 
towards  the  control  of  a  flexible  arm  has  been  made,  but  what 
happens  when  the  arm  carries  a  tip  load?  Will  our  control 
schemes,  derived  for  the  unloaded  arm,  work  as  well  when  load 
is  added? 

These  questions  will  be  answered  in  the  present  chapter. 
We  will  start  again  with  the  case  of  the  very  flexible  loaded 
arm  and  we  will  use  the  best  control  scheme,  found  for  the 
unloaded  arm.  After  that,  we  will  change  the  stiffness  of  the 
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loaded  arm,  increasing  it  by  100  times,  and  we  will  use  the 
control  scheme  which  was  applied  in  Chapter  VII,  where  the 
arm  (100  times  stiffer)  was  unloaded. 

B.  VERY  FLEXIBLE  LOADED  ARM 

In  Chapter  II  the  transfer  function  of  the  very  flexible 
loaded  arm  is  given.  The  arm  carries  a  load  of  0.229  Kg, 
which  is  about  half  the  mass  of  the  arm.  This  load  is 
arbitrary,  and  therefore,  any  conclusion  drawn  for  this  case, 
can  be  generalized  for  any  load.  Also,  the  load  of  0.229  Kg, 
represents  a  big  load  for  the  arm,  considering  its  mass 
(0.686  Kg).  This  is  good,  because  we  will  test  our  system  in 
extreme  operating  conditions. 

Preliminary  studies  on  the  transfer  function  of  the 
flexible  loaded  arm,  are  presented  in  Figures  3.3,  3.4,  3.7 
and  3.8.  The  most  important  observation  from  Figures  3.3  and 
3.4  is  that  the  crossover  frequency  as  well  as  the  resonant 
frequencies  have  been  moved  to  the  left  by  0.4  rad/sec, 
compared  with  the  ones  of  the  unloaded  arm. 

This  loaded  flexible  arm,  was  "connected"  to  the  curve 
following  scheme,  shown  in  Figure  4.10,  and  simulated  using 
the  DSL/VS  program  listed  in  Appendix  B,  having  previously 
substituted  the  new  transfer  function.  The  motion  of  the  tip 
was  recorded  for  two  different  values  of  Ki .  The  first  value 
was  Ki=0.06,  the  sauna  as  the  one  used  for  the  unloaded  arm. 
The  second  value  was  Ki=0.02.  The  results  are  shown  in 
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Figures  8.1  and  8.2  respectively,  for  the  tip  motion.  In 
Figures  8.3  and  8.4  we  see  the  hub  motion  for  the  above 
values  of  Ki  . 

The  hub  motion  in  both  cases  is  excellent.  Therefore  the 
curve  following  system  is  not  affected  by  the  change  of  the 
tip  load,  as  far  as  the  hub  motion  is  concerned.  The  tip 
motion,  however,  is  unacceptable  as  it  was  in  the  case  of  the 
unloaded  arm  also.  Certainly  we  should  not  hope  for  anything 
better. 

The  best  control  scheme,  found  for  the  case  of  the 
unloaded  arm,  will  be  used  to  "shape"  the  tip  motion  of  the 
loaded  arm.  This  scheme  is  shown  in  Figure  6.16.  We  must 
recall  here,  that  the  feedback  compensator,  used  with  the 
linear  regulator  for  the  final  part  of  the  motion,  in  Figure 
6.16,  was  designed  using  the  unloaded  arm,  employing  optimal 
control  theory.  This  compensator  consists  of  a  lead  double¬ 
lag  network  and  two  notch  filters.  The  notches  of  the  filters 
are  placed  exactly  at  the  frequencies  of  the  first  and  second 
vibration  mode  of  the  unloaded  arm.  In  the  case  of  the  loaded 
arm,  where  the  vibration  modes  have  been  moved  to  the  left  by 
0.4  rad/sec,  we  must  expect  poor  results.  This  is  shown  in 
Figures  8.6  through  8.7  for  Ki=0.06.  In  Figure  8.5  the  hub 
motion  is  shown  and  in  Figures  8.6  and  8.7  the  tip  motion 
(small  and  large  displacement  respectively). 

Even  though  the  motion  of  the  tip  has  been  dramatically 
improved,  compared  with  Figure  8.1,  it  is  not  as  good  as  it 
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Figure  8.2  Tip  Motion  Of  The  Loaded  Arm  Using  The  Curve 
Following  System  Alone  (Ki=0.02) 
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Loaded  Arm  Using  The  Curve 
Alone  (Ki=0.02) 


Figure  8.6  Tip  Motion  Of  The  Loaded  Arm  Using  The  System 
Shown  In  Figure  6.16  (Ki=0.06,  Small  Motion) 
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should  be  for  the  field  of  robotics.  In  an  attempt  to  avoid 
the  excitation  of  the  vibration  modes  as  much  as  possible, 
the  constant  K1  was  reduced  to  0.02.  The  simulation  results 
for  that  value  are  shown  in  Figures  8.8,  8.9  and  8.10.  The 

tip  motion  is  better  compared  with  Figures  8.6  and  8.7,  but 
again  is  not  as  good  as  we  would  like  it  to  be. 

We  could  reduce  the  constant  Ki  further,  but  the  settling 
time  would  be  increased  very  much  and  the  signals  coming  out 
of  the  curve  could  not  be  measured  easily  in  a  real 
situation.  Therefore,  one  way  out  of  this  problem  is  to 
redesign  the  feedback  compensator,  making  the  width  of  the 
notches  larger,  so  that  they  could  cover  the  shift  of  the 
frequency  of  the  vibration  modes,  when  the  load  of  the  tip 
changes.  Another  possible  solution  is  to  leave  the  notches  as 
they  are  now,  but  to  move  the  center  of  the  notches  to  the 
frequency  of  the  vibration  modes  in  each  case.  This  requires 
a  method  to  detect  the  frequency  of  the  vibration  modes  and 
use  this  information  to  place  the  notch  of  the  filters.  This 
technique  has  been  successfully  used  in  [Ref.  8],  to 
eliminate  the  bending  modes  of  a  missile. 

Both  ideas  presented  above,  require  a  lot  of  work  and  are 
left  as  recommendations  for  future  study. 

C.  "FLEXIBLE  PRACTICAL"  LOADED  ARM 

In  Chapter  VII  we  studied  the  effects  of  the  stiffness  of 
the  arm  on  the  performance  of  the  curve  following  system. 
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When  the  arm  became  10°  times  stiffer,  a  simple  linear 
regulator  was  used  for  the  final  part  of  the  motion. 

The  same  method  used  to  change  the  stiffness  of  the 
unloaded  arm,  in  Chapter  VII,  applies  also  for  the  case  of 
the  loaded  arm.  The  resulting  transfer  functions  for  the  100 
times  stiffer  arm  are  as  follows. 

Hub  transfer  function  -  Arm  loaded: 

0(s)  44.314(s+l±j24.7)(s+2.4±jl45. I)(s+82±j417) 

T(s)  s( s+0 . 2) ( s+l . 5± jlOO . 5) { s+4± jl94 . 1 ) ( s+8 . 7± j435 . 3 ) 

Tip  transfer  function  -  Arm  loaded: 

y(s)  -0.714(s-127.4)(s+128.9)(s+207.2±j229.4)(s-199±j243.6) 
T(s)  s(s+0.2)(s+l. 5± jlOO . 5 ) ( s+4± jl94 .l)(s+8.7±j435.3) 

The  curve  following  scheme,  shown  in  Figure  4.10  was  used 
again  and  the  simulation  results  are  shown  in  Figures  8.11 
and  8.12  for  the  hub  and  the  tip  motion.  The  tip  motion  has 
still  its  oscillatory  character  but  the  amplitude  of  the 
oscillations  has  been  reduced  very  much. 

The  same  linear  regulator  as  the  one  used  in  the  case  of 
the  unloaded  arm,  in  Chapter  VII,  was  used  here,  for  the 
final  part  of  the  motion  of  the  100  times  stiffer  loaded  arm. 
The  results  of  the  simulation  of  the  system  shown  in  Figure 
6.1,  where  the  appropriate  transfer  functions  have  been 
substituted,  are  shown  in  Figures  8.13  and  8.14.  From  Figure 
8.14  we  see  an  excellent  tip  motion  and  all  oscillations 
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present  in  Figure  8.12  have  been  completely  eliminated  and 
the  overshoot  is  zero. 

We  conclude  again,  as  in  Chapter  VII,  that  the  curve 
following  system  with  the  aid  of  a  simple  compensator,  can  be 
used  very  effectively  for  the  control  of  a  "practical 
flexible"  arm,  for  any  loading  condition  of  the  arm. 


IX. 


As  a  result  of  the  research  conducted  in  this  thesis,  the 
control  of  a  flexible  arm,  with  the  use  of  the  curve 
following  system,  appears  possible,  when  the  appropriate 
linear  regulator,  for  the  final  motion  is  used.  If  the  arm  is 
very  flexible,  the  linear  regulator  has  to  be  very  complex. 
When  the  arm  has  a  practical  stiffness,  however,  the  linear 
regulator  is  very  simple.  Furthermore,  in  this  case  the 
overall  system  is  robust  to  changes  of  the  loading  conditions 
of  the  arm . 

When  the  arm  is  very  flexible,  even  though  the  proposed 
solution  in  Chapter  VI  works  very  well  for  the  case  of  the 
unloaded  arm,  it  does  not  work  as  well  when  the  arm  carries  a 
tip  load.  Two  possible  solutions  to  this  problem  are 
proposed.  First,  the  width  of  the  notches  of  the  feedback 
compensator,  must  become  larger,  so  that  they  can  cover  any 
shift  of  the  frequency  of  the  vibration  modes,  occurring  when 
the  loading  conditions  change.  As  a  second  solution,  the  use 
of  adaptive  notch  filters  can  be  considered.  In  this  case  an 
algorithm  must  be  derived  to  detect  the  resonance  frequencies 
during  the  operation  of  the  system,  and  one  must  use  these 
frequencies  to  place  the  notch  filters  accordingly.  A  similar 
approach  has  been  used  in  [Ref.  8],  but  the  time  required  for 
the  detection  of  the  vibration  modes  there  is  of  the  order  of 
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one  second.  This  is  a  very  large  time  for  the  area  of 
robotics,  and  therefore  [Ref.  8]  is  only  a  starting  point. 
For  our  case  a  much  faster  detection  of  the  vibration  modes 
is  required. 


TITLE  THIS  PROGRAM  INVESTIGATES  THE  ABILITY  OF  THE  BASIC 
TITLE  MODEL  TO  FOLLOW  THE  CURVE  WHEN  WE  USE  VELOCITY  CURVE 
TITLE  FOLLOW  TECHNIQUE. 

PARAM  K1=0 . 40 , K2= 10000 . 0 , KM=17 . 000 , VSAT=50 . 0 , K=1 . 0 

PARAM  REF=0. 1000 

INITIAL 

A=SQRT ( 2 . *KM*VSAT ) 

XDOT=0 . 0 
DERIVATIVE 

R=REF*STEP(0.0) 

E=R-C 

NOSORT 

IF(E . LT . 0 . 0)XDOT=-A*K1*SQRT ( ABS(E) ) 

IF(E.GE.O.O) XD0T=A*K1 *SQRT ( E ) 

SORT 

XDOTE=XDOT-KCDOT 

KCDOT=CDOT*K 

V=LIMIT( -VSAT , VS AT , K2*XDOTE ) 

CDDOT=KM*V 

CDOT= INTGRL (0.0, CDDOT ) 

C=INTGRL(0 . 0 , CDOT) 

TERMINAL 
METHOD  RKSFX 

CONTRL  FINTIM=1 . 50000 , DELT=0 . 00005 , DELS=0 . 00025 
SAVE  (G1)0. 00005, TIME, C.XDOT, CDOT 
SAVE  (G2)0. 00005, TIME, C.REF 

GRAPH(G1/G1 , DE=TEK618 , P0=0 , .5)  C( LE=8 . 0 , UN= ’ RAD’ )  ... 

XDOT( LE=12 , NI=12 , L0=0 , SC=0 . 7 , AX=OMIT)  . . . 
CDOT(LE=12, NI=12,LO=0,SC=0. 7, UN=’ RAD/SEC’ ) 
GRAPH(G2/G2,DE=TEK618,PO=0, .5) 

TIME (LE=8.0,UN=’ SEC’ ,SC=0.0045),  .  .  . 

C(LE=12 , NI=12 , LO=0 , SC=0 . 02 , UN= ’ RAD’ )  . . . 

REF(LE=12 , NI=12 , LO=0 , SC=0 . 02 , AX=OMIT) 

LABEL  (Gl)  PHASE  PLANE 
LABEL  (Gl)  XDOT.CDOT  VS  C 
LABEL  (G2 )  STEP  RESPONSE 
LABEL  (G2 )  C  VS  TIME 
END 
STOP 
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TITLE  SIMULATION  PROGRAM  FOR  THE  WHOLE  SYSTEM 
TITLE  USING  VELOCITY  CURVE  FOLLOW  TECHNIQUE. 

TITLE  THE  ARM  IS  THE  THEORITICAL  VERY  FLEXIBLE  ONE. 

PARAM  K1=0 . 06 , K2=10000 . 0 , KM=1 . 2000 , VSAT=50 . 000 , K=1 . 00 
PARAM  REF=0 . 1700 , CR0=0 . 0 , T=0 . 00005 , KT=1 . 00 , L=1 . 13 
INTGER  N, SW, SW1 

ARRAY  NUMWM( 7 ) , DENWM( 9 ) , NUMTWM( 7 ) 

*  Kl:  THE  CURVE  SCALLING  CONSTANT 

*  K2:  THE  AMPLIFIER  GAIN 

*  KM:  THE  INITIAL  MOTOR  CONSTANT  OF  THE  IDEAL  (MODEL)  MOTOR 

*  VSAT:  THE  SATURATION  LIMITS  OF  THE  AMPLIFIER 

*  K:  THE  VELOCITY  LOOP  FEEDBACK  GAIN  (OF  THE  MODEL) 

*  REF: THE  COMMANDED  HUB  ANGLE  IN  RAD 

*  T:  THE  SAMPLING  INTERVAL 

*  L:  THE  ARM’S  LENGTH 

*  NUMWM  IS  THE  NUMERATOR  OF  THE  HUB  TRANSFER  FUNCTION 

*  OF  THE  ARM  WITHOUT  MASS  AT  THE  TIP. 

*  DENWM  IS  THE  DENOMINATOR  OF  THE  HUB  TRANSFER  FUNCTION 

*  OF  THE  ARM  WITHOUT  MASS  AT  THE  TIP. THIS  DENOMI- 

*  NATOR  IS  THE  SAME  FOR  THE  TIP  TRANSFER  FUNCTION. 

*  NUMTWM  IS  THE  NUMERATOR  OF  THE  TIP  TRANSFER  FUNCTION 

*  OF  THE  ARM  WITHOUT  MASS  AT  THE  TIP. 

TABLE  NUMWM( 1-7 ) =4 . 362E1 , . . . 

1 . 0097978E2 , . . . 

1. 146367857E5, . . . 

1 . 0356489805E5 , . . . 

3. 17957559456E7, . . . 

7 . 5761380523E6 , . . . 

3. 40 664921631 3E8 
TABLE  DENWM( 1-9 )  =  1 , . .  . 

2.78, . . . 

2.919858E3, . . . 

4.3620421E3, . . . 

1 . 4677639854E6 , . . . 

1.01109 90 401 4E6, . . . 

1 . 502577700529E8 , . . . 

3 . 00228461 1578E7 , . . . 

0 

TABLE  NUMTWM ( 1-7 ) =-2 . 177 , . . . 

-3.96214, .  .  . 

-2 . 574372164E2  ,  .  .  . 

-5. 3041198658E3, . . . 

-2. 52831210194E6, . . . 
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5 . 85687441282E5 , . . . 

3 . 817577560845E8 

INITIAL 

A=SQRT(2.*KM*VSAT) 

XDOT=0 . 0 
SW1=0 

R=REF*STEP (0.0) 

DERIVATIVE 

E=R-C 

*********************************************** 
***********  CURVE  CALCULATION  *************** 
*********************************************** 

NOSORT 

IF(E.LT.O.O)XDOT=-A*K1*SQRT(ABS(E) ) 

IF(E . QE . 0 . 0 )XD0T=A*K1*SQRT (E ) 

SORT 

XDOTE=XDOT-KCDOT 

KCDOT=CDOT*K 

V=LIMIT ( -VSAT , VSAT , K2*XDOTE ) 

CDDOT=KM*V 

CDOT= INTGRL( 0 . 0 , CDDOT ) 

C=INTGRL(0 . 0 , CDOT ) 

OKU=KT*V 

CR=TRNFR(  6 , 8 , 0 . 0 ,  NUMWM ,  DENWM ,  OKU ) 

CRDOT=DERIV(0 . 0 , CR) 

YT=TRNFR(6 ,8,0.0, NUMTWM , DENWM , OKU ) 
***************************************************** 
***********  SAMPLING  OF  THE  ARM’S  HUB  *************** 
*************  POSITION  AND  HUB  RATE  ***************** 
***************************************************** 
SAMPLE 
NOSORT 

IF(N.EQ. 0 . 0)GO  TO  20 

IF ( CDOT. GT. XDOT )SW=1 

IF( SW . EQ. 1 )GO  TO  5 

KS=ABS ( 2 . *CR ) / ( ( (N*T)**2)*V) 

KM=KS 

5  CONTINUE 


C=CR 

CDOT=CRDOT 
20  N=N+1 

CONTINUE 

SORT 

TERMINAL 
METHOD  RKSFX 

CONTRL  FINTIM=2 . 0000 , DELT=0 . 00005 , DELS=0 . 00005 
*RINT  0.05.YT 

*AVE  (G1)0. 0001, C, XDOT, CDOT, CRDOT 
*AVE  (G2)0. 0001, TIME, C,CR 
SAVE  (G3)0. 0001, TIME, YT 

GRAPH(G1/G1,DE=TEK618,PO=0, .5)  C(UN=’RAD’ ,LE=8.0) , 
XDOT (LO=0,UN=’ RAD/SEC ’ ,LE=12.0), . . . 


i 
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CDOT ( LO=0 , UN= ’ RAD/SEC ’ ,LE=12.0) , . . . 

CRDOT ( LO=0 , UN= ’ RAD/SEC ’ ,LE=12.0) 

GRAPH (G2/G2 , DE=TEK618 , P0=0 , .5)  TIME( UN= ’ SEC ’ ,LE=8.0) , . 

CR(UN= ' RAD’ ,LE=12.0) 

*  REF(SC=2 . 0 , L0=0 , AX=OMIT ) 

GRAPH ( G3/G3 , DE=TEK6 1 8 , PO=0 ,0.5)  TIME ( UH=  *  SEC  * , LE=8 . 0 ) , 
YT( UN =’ METERS’ ,LE=12.0) 

LABEL  (Gl)  PHASE  PLANE 

LABEL  (Gl)  XDOT , CDOT , CRDOT  VS  C 

LABEL  ( G2 )  STEP  RESPONSE 

LABEL  (G2 )  C.CR  VS  TIME 

LABEL  (G3 )  MOTION  OF  THE  ARM’S  TIP 

LABEL  (G3 )  YT  VS  TIME 

END 

STOP 
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APPENDIX  C 


SIMULATION  PROGRAM  FOR  THE  WHOLE  SYSTEM  USING  CURVE 
FOLLOWING  TECHNIQUE  FOR  THE  FIRST  PART  OF  THE  MOTION 
AND  SWITCHING  TO  A  SIMPLE  LINEAR  REGULATOR  FOR  THE 

FINAL  HQTIQN 


TITLE  SIMULATION  PROGRAM  FOR  THE  WHOLE  SYSTEM 
TITLE  USING  VELOCITY  CURVE  FOLLOW  TECHNIQUE  SWITCHING  TO 
TITLE  LINEAR  MODE  (SIMPLE  SYSTEM)  FOR  THE  FINAL  MOTION. 
PARAM  K1=0 . 06 , K2=10000 . 0 , KM=1 . 2000 , VSAT=50 . 000 , K=1 . 00 
PARAM  REF=0 . 1700 ,CR0=0.0, T=0 . 00005 , KT=1 . 00 , L=1 . 13 
INTGER  N, SW, SW1 

ARRAY  NUMWM( 7 ) , DENWM( 9 ) , NUMTWM( 7 ) , NUMF1 ( 2 ) , DENF1 ( 2 ) 

ARRAY  NUMF2 ( 1 ) , DENF2 ( 3 ) 

*  Kl:  THE  CURVE  SCALLING  CONSTANT 

*  K2:  THE  AMPLIFIER  GAIN 

*  KM:  THE  INITIAL  MOTOR  CONSTANT  OF  THE  IDEAL  (MODEL)  MOTOR 

*  VSAT :  THE  SATURATION  LIMITS  OF  THE  AMPLIFIER 

*  K:  THE  VELOCITY  LOOP  FEEDBACK  GAIN  (OF  THE  MODEL) 

*  REF: THE  COMMANDED  HUB  ANGLE  IN  RAD 

*  T:  THE  SAMPLING  INTERVAL 

*  L:  THE  ARM’S  LENGTH 

*  NUMWM  IS  THE  NUMERATOR  OF  THE  HUB  TRANSFER  FUNCTION 

*  OF  THE  ARM  WITHOUT  MASS  AT  THE  TIP. 

*  DENWM  IS  THE  DENOMINATOR  OF  THE  HUB  TRANSFER  FUNCTION 

*  OF  THE  ARM  WITHOUT  MASS  AT  THE  TIP. THIS  DENOMI- 

*  NATOR  IS  THE  SAME  FOR  THE  TIP  TRANSFER  FUNCTION. 

*  NUMTWM  IS  THE  NUMERATOR  OF  THE  TIP  TRANSFER  FUNCTION 

*  OF  THE  ARM  WITHOUT  MASS  AT  THE  TIP. 

*  NUMF1 , DENF1 , NUMF2 , DENF2  ARK  THE  NUMERATORS  AND  THE 

*  DENOMINATORS  OF  THE  FILTERS  THAT  COMPRISE  THE 

*  LINEAR  COMPENSATOR. 

TABLE  NOMWM( 1-7 ) =4 . 362E1 , . . . 


a 


1 . 0097976E2 , . . . 

1 . 146367857E5, . . . 
1 . 0358489805E5 , . . 
3. 17957559456E7 , . 
7.5761380523E6, . . 
3 . 40664921 63 13E8 
TABLE  DENWM ( 1-9 ) =1 , . . . 

2.78, . . . 

2. 919858E3, . . . 
4.3620421E3, . . . 

1 . 4677639854E6, . . 
1 . 01 1099040 14E6 , . 
1 . 502577700529E8 , 
3. 0022846 11 57 8E7 , 
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0 

TABLE  NUMTWM (l-7)=-2.177, . . . 

-3.96214, . . . 

-2 . 574372164E2  ,  .  .  . 

-5.3O41198650E3, .  .  . 

-2 . 52831210194E6 ,  .  .  . 

5.85687441282E5, . . . 

3 . 817577560845E8 
TABLE  NUMF1 ( 1-2 ) =0 . 5 , 0 . 25 
TABLE  DENF1( 1-2) =0.5,1 
TABLE  NUMF2 ( 1 ) =16 
TABLE  DENF2 ( 1-3 ) =1 , 1 . 6 , 16 
INITIAL 

A=SQRT(2.*KM*VSAT) 

XDOT=0 . 0 
SW1=0 

YCOM=L*SIN(REF) 

R=REF*STEP( 0 . 0 ) 

CRITL= ( 90 . *YCOM)/100 . 

DERIVATIVE 

E=R-C 

*********************************************** 
***********  CURVE  CALCULATION  *************** 
*********************************************** 

NOSORT 

IF(E.LT.O.O)XDOT=-A*K1*SQRT(ABS(E) ) 

IF ( E . GE . 0 . 0 ) XD0T=A*K1*SQRT ( E ) 

SORT 

XDOTE=XDOT-KCDOT 

KCDOT=CDOT*K 

V=LIMIT ( - VSAT , VSAT , K2*XDOTE ) 

CDDOT=KM*V 

CDOT=INTGRL(0 . 0 , CDDOT ) 

C=INTGRL(0 . 0 , CDOT ) 

INPUT=KT*V 

******************************************************** 
***********  SWITCHING  TO  THE  LINEAR  MODE  *************** 
******************************************************** 
NOSORT 

IF(YT.LE.CRITL)OKU=INPUT 

IF(YT.GT.CRITL)OKU=OKUl 

SORT 

CR=TRNFR(6, 8,0.0, NUMWM , DENWM , OKU ) 

CRDOT=DERIV(0 . 0 , CR) 

YT= TRNFR ( 6 , 8 , 0 . 0 , NUMTWM , DENWM , OKU ) 

ER=YCOM-YT 

0UTF1=TRNFR( 1 , 1 , 0 . 0 , NUMF1 , DENF1 , ER) 

OKU1=TRNFR(0 , 2,0.0, NUMF2 , DENF2 , OUTF1 ) 
***************************************************** 
***********  SAMPLING  OF  THE  ARM’S  HUB  *************** 
*************  POSITION  AND  HUB  RATE  ***************** 
***************************************************** 


SAMPLE 

NOSORT 

IF(N . EQ. 0 . 0 )GO  TO  20 
IF ( CDOT . QT . XDOT ) SW= 1 
IF(SW. EQ. 1 )GO  TO  5 
KS=ABS(2.*CR)/(((N*T)**2)*V) 

KM=KS 

5  CONTINUE 

C=CR 

CDOT=CRDOT 
20  N=N+1 

CONTINUE 

SORT 

TERMINAL 
METHOD  RKSFX 

CONTRL  FINTIM=10 . 000 , DELT=0 . 00005 , DELS=0 . 00005 
♦RINT  0.05.YT 

*AVE  ( G1 ) 0 . 000 1 ,  C , XDOT , CDOT , CRDOT 
SAVE  (G2)0. 001, TIME ,CR 
SAVE  (G3)0. 001, TIME, YT 

GRAPH(G1/G1,DE=TEK618,PO=0, .5)  C(UN=’RAD’ ,LE=8.0), . . . 
XDOT ( L0=0 , UN= ’ RAD/SEC ’ ,LE=12.0) , . . . 

CDOT (LO=0,UN=’ RAD/SEC’ ,LE=12.0), . . . 

CRDOT (LO=0,UN=’ RAD/SEC  * ,LE=12.0) 
GRAPH(G2/G2,DE=TEK618,PO=0, .5)  TIME (UN=’ SEC’ ,LE=8.0) , . 
CR(UN= ’RAD’ ) 

*  REF(SC=2 . 0 , L0=0 , AX=OMIT) 

GRAPH ( G3 /G3 , DE=TEK6 1 8 , P0=0 , 0 . 5 )  T IME ( UN= ’ SEC ’ , LE=8 . 0 ) , 
YT(UN=’ METERS’ ) 

LABEL  (Gl)  PHASE  PLANE 

LABEL  (Gl)  XDOT, CDOT, CRDOT  VS  C 

LABEL  (G2)  STEP  RESPONSE 

LABEL  (G2 )  C,CR  VS  TIME 

LABEL  (G3)  MOTION  OF  THE  ARM’S  TIP 

LABEL  (G3 )  YT  VS  TIME 

END 

STOP 


APPENEIX  P 


SIMULATION  SYSTEM  FOR  THE  WHOLE  SYSTEM  USING  CURVE 
FOLLOWING  TECHNIQUE  AND  POSI-CAST  CONTROL 


TITLE  SIMULATION  PROGRAM  FOR  THE  WHOLE  SYSTEM 
TITLE  USING  VELOCITY  CURVE  FOLLOW  TECHNIQUE, 

TITLE  APPLYING  POSY  CAST  CONTROL. 

PARAM  K1=0 . 06 , K2=10000 . 0 , KM=1 . 2000 , VSAT=50 . 000 , K=1 . 00 
PARAM  REF1=0 . 1700 , REF2=0 . 320 , CR0=0 . 0 , T=0 . 00005 , KT=1 . 00 , L=1 . 13 


INTGER  N,SW,SW1 

ARRAY  NUMWM( 7 ) , DENWM( 9 ) , NUMTWM( 7 ) 

*  Kl:  THE  CURVE  SCALLING  CONSTANT 

*  K2:  THE  AMPLIFIER  GAIN 

*  KM:  THE  INITIAL  MOTOR  CONSTANT  OF  THE  IDEAL  (MODEL)  MOTOR 

*  VSAT :  THE  SATURATION  LIMITS  OF  THE  AMPLIFIER 

*  K:  THE  VELOCITY  LOOP  FEEDBACK  GAIN  (OF  THE  MODEL) 

*  REF: THE  COMMANDED  HUB  ANGLE  IN  RAD 

*  T:  THE  SAMPLING  INTERVAL 

*  L:  THE  ARM’S  LENGTH 

*  NUMWM  IS  THE  NUMERATOR  OF  THE  HUB  TRANSFER  FUNCTION 

*  OF  THE  ARM  WITHOUT  MASS  AT  THE  TIP. 

*  DENWM  IS  THE  DENOMINATOR  OF  THE  HUB  TRANSFER  FUNCTION 

*  OF  THE  ARM  WITHOUT  MASS  AT  THE  TIP. THIS  DENOMI- 

*  NATOR  IS  THE  SAME  FOR  THE  TIP  TRANSFER  FUNCTION. 

*  NUMTWM  IS  THE  NUMERATOR  OF  THE  TIP  TRANSFER  FUNCTION 

*  OF  THE  ARM  WITHOUT  MASS  AT  THE  TIP. 

TABLE  NUMWM( 1-7 ) =4 . 362E1 , . . . 

1 . 0097978E2 , . . . 

1. 146367857E5, . . . 

1 . 035846 960 5E5 , . . . 

3. 17957559456E7 , . . . 

7 . 5761360523E6 , . . . 

3 . 40664921631 3E8 
TABLE  DENWM ( 1  —  9 )  =  1 , . . . 

2.78, . . . 

2. 919858E3, . . . 

4 . 3620421E3 , . . . 

1 . 4677639854E6 , . . . 

1 . 01 10990 401 4E6 , . . . 

1 . 50 257 7700 5 2 9E8 , . . . 

3 . 002 2846 11 57 8E7 , . . . 

0 

TABLE  NUMTWM ( 1-7 ) =-2 . 177, . . . 

-3.96214, .  .  . 

-2. 574372164E2, . . . 

-5 . 3041198658E3 , . . . 
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-2.52831210194E6, . . . 

5 . 8568744 1282E5 , . . . 

3 . 817577560845E8 

INITIAL 

A=SQRT(2.*KM*VSAT) 

XDOT=0 . 0 
SW1=0 

DERIVATIVE 

R=REF 1 *STEP ( 0 . 0 ) -REF1*STEP( 0 . 95 ) +REF2*STEP( 0 . 95 ) 
E=R-C 

********************************************** 
**********  CURVE  CALCULATION  *************** 
********************************************** 

NOSORT 

IF(E. LT . 0 . 0 )XDOT=-A*Kl*SQRT( ABS(E) ) 

IF( E . GE . 0 . 0 )XDOT=A*Kl*SQRT ( E ) 

SORT 

YCOM=L*SIN(R) 

XDOTE=XDOT-KCDOT 
KCDOT = CDOT  *K 

V=LIMIT( -VS AT, VS AT , K2*XDOTE ) 

CDDOT=KM*V 

CDOT= INTGRL (O.O, CDDOT ) 

C= INTGRL (0.0, CDOT ) 

OKU=KT*V 

CR=TRNFR ( 6 , 8 , 0 . 0 , NUMWM , DENWM , OKU ) 

CRDOT=DERIV(0 . 0 , CR) 

YT = TRNFR ( 6 , 8 , 0 . 0 , NUMTWM , DENWM , OKU ) 
***************************************************** 
***********  SAMPLING  OF  THE  ARM’S  HUB  *************** 
*************  POSITION  AND  HUB  RATE  ***************** 
***************************************************** 
SAMPLE 
NOSORT 

IF(N.EQ.O.O)GO  TO  20 
IF ( CDOT . GT . XDOT ) SW= 1 
IF(SW.EQ.l)GO  TO  5 
KS=ABS(2.*CR)/(((N*T)**2)*V) 

KM=KS 

5  CONTINUE 

C=CR 

CDOT=CRDOT 
20  N=N+1 

CONTINUE 

SORT 

TERMINAL 
METHOD  RKSFX 

CONTRL  FINTIM=5 . 0000 , DELT=0 . 00005 , DELS=0 . 00005 
PRINT  0.5.YT 

*AVE  (G1)0. 0001, C, XDOT, CDOT, CRDOT 
*AVE  (G2)0.001,R,CR 
SAVE  (G3 )0 . 001 , YT 
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*AVE  (04)0. 0001, CR, OKU 

GRAPH(G1/G1 , DE=TEK618 , P0=0 , .5)  C(UN=’RAD* ,LE=8.0), . . . 

XDOT ( L0=0 ,  UN=  ’ RAD/SEC  * ), . . . 

*  CDOT ( L0=0 , UN= ’ RAD/SEC '),... 

CRDOT ( L0=0 , UH= ’ RAD/SEC ’ ) 

GRAPH(G2/G2,DE=TEK61B,PO=0, .5)  TIME(UN= ' SEC’ , LE=8 . 0 ) , . . . 
CR(UN=’RAD’LO=0.0,SC=50E-3), . . . 

R( L0=0 . 0 , SC=50E-3 , AX=OMIT) 

*  REF ( SC=2 . 0 , L0=0 , AX=OMIT ) 

GRAPH (G3/G3 , DE=TEK618 , P0=0 ,0.5)  TIME (UN=* SEC' ,LE=8.0) , . . . 
YT ( ON  = ' METERS ’ , LO = - 50E - 3 , SC = 100E - 3 ) 

*  YCOM( LO=-50E-3 , SC=100E-3 , AX = OMIT ) 

GRAPH  ( G4/G4 ,  DE=TEK6 1 8  ,  PO=0 ,0.5)  TIME(UN=  ’  SEC'  ,LE=8.0),  .  .  . 
OKU(UN= ’ NM’ ), . . . 

CR(UN='RAD’ , AX=OMIT) 

LABEL  (Gl)  PHASE  PLANE 

LABEL  (Gl)  XDOT, CDOT, CRDOT  VS  C 

LABEL  (G2)  STEP  RESPONSE 

LABEL  (G2)  COMMAND  AND  CR  VS  TIME 

LABEL  (G3)  MOTION  OF  THE  ARM'S  TIP 

LABEL  (G3 )  YT  VS  TIME 

END 

STOP 
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1 


v. s.s 


TITLE  SIMULATION  PROGRAM  FOR  THE  WHOLE  SYSTEM 

TITLE  USING  VELOCITY  CURVE  FOLLOW  TECHNIQUE  SWITCHING  TO 

TITLE  LINEAR  MODE  FOR  THE  FINAL  MOTION. 

TITLE  (  USE  OF  THE  FEEDBACK  COMPENSATOR  ) 

PARAM  K1=0 . 06 , K2=10000 . 0 , KM=1 . 2000 , VSAT=50 . 000 , K=1 . 00 
PARAM  REF=0 . 1700 , CR0=0 . 0 , T=0 . 00005 , KT=1 . 00 , L=1 . 13 
PARAM  KB=0. 1012, BM=0 . 04297 
INTGER  N.SW.SWl 

ARRAY  NUMWM( 7 ) , DENWM( 9 ) , NUMTWM( 7 ) , NUMCOT( 8 ) , DENCOT ( 9 ) 

*  Kl:  THE  CURVE  SCALLING  CONSTANT 

*  K2:  THE  AMPLIFIER  GAIN 

*  KM:  THE  INITIAL  MOTOR  CONSTANT  OF  THE  IDEAL  (MODEL)  MOTOR 

*  VSAT :  THE  SATURATION  LIMITS  OF  THE  AMPLIFIER 

*  K:  THE  VELOCITY  LOOP  FEEDBACK  GAIN  (OF  THE  MODEL) 

*  REF: THE  COMMANDED  HUB  ANGLE  IN  RAD 

*  T:  THE  SAMPLING  INTERVAL 

*  L:  THE  ARM’S  LENGTH 

*  NUMWM  IS  THE  NUMERATOR  OF  THE  HUB  TRANSFER  FUNCTION 

*  OF  THE  ARM  WITHOUT  MASS  AT  THE  TIP. 

*  DENWM  IS  THE  DENOMINATOR  OF  THE  HUB  TRANSFER  FUNCTION 

*  OF  THE  ARM  WITHOUT  MASS  AT  THE  TIP. THIS  DENOMI- 

*  NATOR  IS  THE  SAME  FOR  THE  TIP  TRANSFER  FUNCTION. 

*  NUMTWM  IS  THE  NUMERATOR  OF  THE  TIP  TRANSFER  FUNCTION 

*  OF  THE  ARM  WITHOUT  MASS  AT  THE  TIP. 

*  NUMCOT  IS  THE  NUMERATOR  OF  THE  FEEDBACK  COMPENSATOR  USING 

*  FEEDBACK  ONLY  FROM  THE  TIP  MOTION. 

*  DENCOT  IS  THE  DENOMINATOR  OF  THE  FEEDBACK  COMPENSATOR 
ABOVE. 

TABLE  NUMWM( 1-7 ) =4 . 362E1 , .  .  . 

1.0097978E2, . . . 

1 . 146367857E5 , . . . 

1 . 03 584 8980 5E5 , . . . 

3 . 17957559456E7 , . . . 

7 . 576 13 80 5 2 3E6 , . . . 

3 . 40664921 63 13E8 
TABLE  DENWM { 1-9 ) =1 , . . . 

2.78, . . . 

2.919858E3, . . . 

4 . 3620421E3 , . . . 

1 . 4677639854E6 , . . . 

1 . 01 1099040 14E6 , . . . 


1 . 502577700529E8 , . . . 

3 . 00 22 846 11 57 8E7 , . . . 

0 

TABLE  NUMTWM( 1-7 ) =~2 . 177, . . . 

-3.96214, . . . 

-2 .  574372 164E2 , . . . 

-5 . 3041198658E3 , . . . 

-2. 52831210194E6, . . . 

5 . 85667 44 128 2E5 , . . . 

3. 8175775 60 84 5E8 
TABLE  NUMCOT( 1-8 ) =1160 . 3 , . . . 

-2 . 517851E4 , . . . 

5 . 54202211E6 , . . . 

-1 . 721367358E7 , .  .  . 

4 . 9507558 568 5E9 , . . . 

-1 . 0001 00285 2E10 , . . . 

7 . 7628 144 1950E11 , . . . 
1.20376275595E12 
TABLE  DEHCOT ( 1 - 9 ) = 1 , . .  . 

107.1, . . . 

8565.06, . . . 

4 . 53977023E5 , . .  . 

1 . 714597556E7 , . . . 

4 . 74104184707E8, . .  . 

9. 174522576342E9, . . . 

1 . 18930489797E11 , . . . 

6 . 64749 102467E11 

INITIAL 

A=SQRT ( 2 . *KM*VSAT ) 

XDOT=0 . 0 
SW1=0 

YCOM=L*SIN(REF) 

R=REF*STEP( 0 . 0 ) 

YCOMl=L*SIN(REF) *1 . 81 
CRITL= ( 50 . *YCOM ) /100 . 

DERIVATIVE 

E=R-C 

*********************************************** 
***********  CURVE  CALCULATION  *************** 
*********************************************** 
NOSORT 

IF(E. LT. 0 . 0)XDOT=-A*K1*SQRT(ABS(E) ) 

IF ( E . GE . 0 . 0 ) XDOT = A*K1 *SQRT ( E ) 

SORT 

XDOTE=XDOT-KCDOT 

KCDOT=CDOT*K 

V=LIMIT ( -VSAT , VSAT , K2*XDOTE ) 

CDDOT=KM*V 

CDOT = INTGRL (0.0, CDDOT ) 

C= INTGRL (0.0, CDOT ) 

INPUT=KT*V 


***********  SWITCHING  TO  THE  LINEAR  MODE  *************** 
******************************************************** 
NOSORT 

IF(YT.LE.CRITL)OKU= INPUT 
IF(YT.GT. CRITL)OKU=OKUl 

SORT 

CR=TRNFR ( 6 , 8 , 0 . 0 , NUMWM , DENWM , OKU ) 
CRDOT=DERIV(0.0,CR) 

YT=TRNFR( 6 ,8,0.0, NUMTWM , DENWM , OKU ) 

FTIP=TRNFR( 7 ,8,0.0, NUMCOT , DENCOT , YT ) 
0KU1=YC0M1-FTIP 

***************************************************** 
***********  SAMPLING  OF  THE  ARM’S  HUB  *************** 
*************  POSITION  AND  HUB  RATE  ***************** 
***************************************************** 
SAMPLE 
NOSORT 

IF(N.EQ. 0 . 0 )GO  TO  20 

IF ( CDOT . GT . XDOT ) SW= 1 

IF(SW.EQ. 1 )GO  TO  5 

KS=ABS ( 2 . *CR ) / ( ( (N*T)**2)*V) 

KM=KS 

5  CONTINUE 

C=CR 

CDOT=CRDOT 
20  N=N+1 

CONTINUE 

SORT 
TERMINAL 
METHOD  RKSFX 

CONTRL  FINTIM=2 . 0000 , DELT=0 . 00005 , DELS=0 . 00005 
*RINT  0.05.YT 

*AVE  (G1)0. 0001, C, XDOT, CDOT, CRDOT 
*AVE  (G2)0. 0001, TIME, C,CR 
SAVE  (G3)0. 0001, TIME, YT 

GRAPH (Gl/Gl , DE=TEK618 , P0=0 , .5)  C(UN='RAD' ,LE=8.0) , . . . 

XDOT (LO=0,UN=’ RAD/SEC ’ ,LE=12.0), . . . 

CDOT  (LO=0,UN=’ RAD/SEC \LE=1 2. 0 ),  . . . 

CRDOT (LO=0,UN=’ RAD/SEC’ ,LE=12.0) 

GRAPH(G2/G2 , DE=TEK618 , P0=0 , .5)  TIME( UN= ’ SEC’ ,LE=8.0), . . . 

CR(UN=’RAD’ ,LE=12.0) 

*  REF ( SC =2 . 0 , L0=0 , AX=OMIT ) 

GRAPH (G3/G3 , DE=TEK618 , P0=0 ,0.5)  TIME(UN= ’ SEC’ ,LE=8.0), . . . 

YT(UN= 'METERS’ ,LE=12.0) 

LABEL  (Gl)  PHASE  PLANE 

LABEL  (Gl)  XDOT, CDOT, CRDOT  VS  C 

LABEL  (G2 )  STEP  RESPONSE 

LABEL  (G2)  C,CR  VS  TIME 

LABEL  (G3 )  MOTION  OF  THE  ARM’S  TIP 

LABEL  (G3)  YT  VS  TIME 

END 

STOP 
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TITLE  SIMULATION  PROGRAM  FOR  THE  WHOLE  SYSTEM 
TITLE  USING  VELOCITY  CURVE  FOLLOW  TECHNIQUE.  THE  ARM  IS 
TITLE  20  TIMES  STIFFER  THAN  THE  THEORETICAL  ONE 
PARAM  K1=0 . 06 , K2=10000 . 0 , KM=1 . 2000 , VSAT=50 . 000 , K=1 . 00 
PARAM  REF=0 .1700, CR0=0 . 0 , T=0 . 00005 , KT=1 . 00 , L=1 . 13 
INTGER  N,SW,SW1 

ARRAY  NUMWM( 7 ) , DENWM( 9 ) , NUMTWM( 7 ) 

*  Kl:  THE  CURVE  SCALLING  CONSTANT 

*  K2:  THE  AMPLIFIER  GAIN 

*  KM:  THE  INITIAL  MOTOR  CONSTANT  OF  THE  IDEAL  (MODEL)  MOTOR 

*  VSAT:  THE  SATURATION  LIMITS  OF  THE  AMPLIFIER 

*  K:  THE  VELOCITY  LOOP  FEEDBACK  GAIN  (OF  THE  MODEL) 

*  REF: THE  COMMANDED  HUB  ANGLE  IN  RAD 

*  T:  THE  SAMPLING  INTERVAL 

*  L:  THE  ARM’S  LENGTH 

*  NUMWM  IS  THE  NUMERATOR  OF  THE  HUB  TRANSFER  FUNCTION 

*  OF  THE  ARM  WITHOUT  MASS  AT  THE  TIP. 

*  DENWM  IS  THE  DENOMINATOR  OF  THE  HUB  TRANSFER  FUNCTION 

*  OF  THE  ABM  WITHOUT  MASS  AT  THE  TIP. THIS  DENOMI- 

*  NATOR  IS  THE  SAME  FOR  THE  TIP  TRANSFER  FUNCTION. 

*  NUMTWM  IS  THE  NUMERATOR  OF  THE  TIP  TRANSFER  FUNCTION 

*  OF  THE  ARM  WITHOUT  MASS  AT  THE  TIP. 

TABLE  NUMWM ( 1-7)=46.321, . . . 

1009.8, . . . 

1 . 146 367857 1E7 , . . . 

1 . 0 3584 8980 53E8, . . . 

3. 17957559457E11, . . . 

7 . 57613805235E11 , . . . 

3.40664921631E14 
TABLE  DENWM( 1-9 ) =1 , . . . 

26.0,  ..  . 

2 . 9803594E5 , . . . 

3 . 90728207E6 , . . . 

1. 50406090396E10,  .  .  . 

7.64243888420E10, .  .  . 

1. 5 40 8976317 7E 14, . . . 

3 . 08150159785E13 , . . . 

0 

TABLE  NUMTWM( 1-7 ) =-2 . 177 , . . . 

-3 . 96214E1 , . . . 

-2 . 552 33322 16E4 , . . . 

-5 . 20524865907E6 , . . . 

-2. 52622973 5E 10, . . . 
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5.71507551855E10, . . . 

3. 81407740623E14 

INITIAL 

A=SQRT ( 2 . *KM*VSAT ) 

XDOT=0 . 0 
SW1=0 

YCOM=L*SIN(REF) 

R=REF*STEP (0.0) 

DERIVATIVE 

E=R-C 

*********************************************** 
***********  CURVE  CALCULATION  *************** 
*********************************************** 

NOSORT 

IF ( E . LT . 0 . 0 ) XDOT = - A*K 1 * SORT ( ABS (E) ) 

IF(E . GE . 0 . 0 )XD0T=A*K1*SQRT(E ) 

SORT 

XDOTE =XDOT - KCDOT 
KCDOT =CDOT*K 

V=LIMIT( -VSAT , VSAT , K2*XDOTE ) 

CDDOT=KM*V 

CDOT= INTGRL (0.0, CDDOT ) 

C= INTGRL (0.0, CDOT ) 

OKU=KT*V 

CR=TRNFR ( 6 , 8 , 0 . 0 , NUMWM , DENWM , OKU ) 

CRDOT=DERIV(0 . 0 , CR) 

YT=TRNFR( 6 ,8,0.0, NUMTWM, DENWM, OKU) 
***************************************************** 
***********  SAMPLING  OF  THE  ARM’S  HUB  *************** 
*************  POSITION  AND  HUB  RATE  ***************** 
***************************************************** 
^ AMPLE 
i^jSORT 

IF(N.EQ. 0 . 0 )GO  TO  20 
IF ( CDOT . GT . XDOT ) SW= 1 
IF(SW.EQ. 1 )GO  TO  5 
KS=ABS(2. *CR)/( ( (N*T)**2)*V) 

KM=KS 

5  CONTINUE 

C=CR 

CDOT=CRDOT 
20  N=N+1 

CONTINUE 

SORT 

TERMINAL 
METHOD  RKSFX 

CONTRL  FINTIM=2 . 0000 , DELT=0 . 00005 , DELS=0 . 00005 
*RINT  0 . 05 , YT 

*AVE  (G1)0. 0001, C, XDOT, CDOT, CRDOT 
*AVE  (G2)0. 0001, TIME, C,CR 
SAVE  (G3)0. 0001, TIME, YT,CR 

GRAPH(G1/G1,DE=TEK618,PO=0, .5)  C(UN= ’ RAD’ , LE=6 . 0 ) , . . . 
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XDOT ( L0=0 , UN= ’  RAD/SEC ’ ,LE=6.0), . . . 

CDOT ( L0=0 , UN= ’ RAD/SEC ’ , LE=6 . 0 )  , 

CRDOT ( LO=0 , UN= ' RAD/SEC ’ ,LE=6.0) 

GRAPH (G2/Q2 , DE=TEK618 , P0=0 , .5)  TIME(UN= ’ SEC’ ,LE=6.0), . 

CR(UN=’RAD’ , LE=6 . 0 ) 

*  REF ( SC=2 . 0 , LO=0 , AX=OMIT ) 

GRAPH (G3/G3 , DE=TEK618 , P0=0 ,0.5)  TIME ( UN= ’ SEC ’ ,LE=8.0) , 
YT(UN=’ METERS’ ,LE=7.5),CR 
LABEL  (Gl)  PHASE  PLANE 
LABEL  (Gl)  XDOT, CDOT, CRDOT  VS  C 
LABEL  (G2 )  STEP  RESPONSE 
LABEL  (G2 )  C,CR  VS  TIME 
LABEL  (G3 )  MOTION  OF  THE  ARM’S  TIP 
LABEL  (G3 )  YT  VS  TIME 
END 
STOP 


Jj 


TITLE  SIMULATION  PROGRAM  FOR  THE  WHOLE  SYSTEM 
TITLE  USING  VELOCITY  CURVE  FOLLOW  TECHNIQUE.  THE  ARM  IS 
TITLE  50  TIMES  STIFFER  THAN  THE  THEORETICAL  ONE 
PARAM  K1=0 . 06 , K2=10000 . 0 , KM=1 . 2000 , VSAT=50 . 000 , K=1 . 00 
PARAM  REF=0. 1700, CR0=0.0,T=0. 00005, KT=1. 00, L=l. 13 
INTGER  N, SW, SW1 

ARRAY  NUMWM( 7 ) , DENWM( 9 ) , NUMTWM( 7 ) 

*  Kl:  THE  CURVE  SCALLING  CONSTANT 

*  K2  •-  THE  AMPLIFIER  GAIN 

*  KM:  THE  INITIAL  MOTOR  CONSTANT  OF  THE  IDEAL  (MODEL)  MOTOR 

*  VSAT:  THE  SATURATION  LIMITS  OF  THE  AMPLIFIER 

*  K:  THE  VELOCITY  LOOP  FEEDBACK  GAIN  (OF  THE  MODEL) 

*  REF: THE  COMMANDED  HUB  ANGLE  IN  RAD 

*  T:  THE  SAMPLING  INTERVAL 

*  L:  THE  ARM’S  LENGTH 

*  NUMWM  IS  THE  NUMERATOR  OF  THE  HUB  TRANSFER  FUNCTION 

*  OF  THE  ARM  WITHOUT  MASS  AT  THE  TIP. 

*  DENWM  IS  THE  DENOMINATOR  OF  THE  HUB  TRANSFER  FUNCTION 

*  OF  THE  ARM  WITHOUT  MASS  AT  THE  TIP. THIS  DENOMI- 

*  NATOR  IS  THE  SAME  FOR  THE  TIP  TRANSFER  FUNCTION. 

*  NUMTWM  IS  THE  NUMERATOR  OF  THE  TIP  TRANSFER  FUNCTION 

*  OF  THE  ARM  WITHOUT  MASS  AT  THE  TIP. 

TABLE  NUMWM( 1-7 ) =46 . 321 , . . . 

714.03, . . . 

5 . 7318392057E6 , . . . 

3 . 6622791 92 1E07 , . . . 

7.94893898642E10, . . . 

1.33928464 800E 11, . . . 

4. 25831 15203 9E 13 
TABLE  DENWM ( 1 - 9 ) = 1 , . . . 

1 . 84433549E1 , . . . 

1 . 4597074867 1E5 , . . . 

1.36 49795418 8E6, . . . 

3 . 66778803401E9 , . . . 

1.34 20 721104 4E 10, . . . 

1.87668162657E13, . . . 

3. 7528557644 7E 12, . . . 

0 

TABLE  NUMTWM ( l-7)=-2.177, . . . 

-28.016560, . . . 

-1 . 2761661E4 , . . . 

-1 . 8403333 1229E6 , . . . 

-6. 31557433757E9, . . . 
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1 . 0102921 6 354E 10 , . . . 

4 . 767596757 79E1 3 

INITIAL 

A=SQRT ( 2 . *KM*VSAT ) 

XDOT=0 . 0 
SW1=0 

YCOM=L*SIN(REF) 

R=REF*STEP(0.0) 

DERIVATIVE 

E=R-C 

******************************************,t(*)|()((* 
***********  CURVE  CALCULATION  *************** 

*****************************************„[,<£*)(t)(t)([ 

NOSORT 

IF ( E . LT . 0 . 0 ) XD0T=-A*K1*SQRT ( ABS ( E ) ) 
IF(E.GE.O.O)XDOT=A*K1*SQRT(E) 

SORT 

XDOTE=XDOT-KCDOT 

KCDOT=CDOT*K 

V=LIMIT ( - VSAT , VSAT , K2*XD0TE ) 

CDDOT=KM*V 

CDOT= INTGRL (0.0, CDDOT ) 

C=INTGRL(0 . 0 , CDOT) 

OKU=KT*V 

CR=TRNFR ( 6 , 8 , 0 . 0 , NUMWM , DENWM , OKU ) 

CRDOT=DERIV(0 . 0 , CR) 

YT=TRNFR( 6 ,8,0.0, NUMTWM , DENWM , OKU ) 
**************************************<t#<[<i,[<|^<[><i^<^ 
***********  SAMPLING  OF  THE  ARM'S  HUB  *************** 
*************  POSITION  AND  HUB  RATE  ***************** 

******************  *  *  *  *  *  *  *  *  *  *  *  *  *  *  4c  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  ^  ^ 

SAMPLE 

NOSORT 

IF(N . EQ. 0 . 0 )G0  TO  20 
IF ( CDOT . GT . XDOT ) SW= 1 
IF( SW. EQ. 1 )GO  TO  5 
KS=ABS(2.*CR)/(((N*T)**2)*V) 

KM-KS 

5  CONTINUE 

C=CR 

CDOT=CRDOT 
20  N=N+1 

CONTINUE 

SORT 

TERMINAL 
METHOD  RKSFX 

CONTRL  FINTIM=5. 0000, DELT=0. 00005, DELS=0  00005 
PRINT  0.05, TIME 

*AVE  (G1)0. 0001, C, XDOT, CDOT.CRDOT 
*AVE  (G2)0. 0001, TIME, C,CR 
SAVE  (G3)0. 0001, TIME, YT 

GRAPH (Gl/Gl , DE=TEK618 , P0=0 , .5)  C(UN=’RAD’ ,LE=8.0) , 
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XDOT ( L0=0 ,  UN=  ’ RAD/SEC ’ ,LE=6.0) , . . . 

CDOT ( L0=0, UN =’ RAD/SEC’ ,LE=6.0)  , 

CRDOT ( L0=0 , UN  = ’ RAD/SEC ’ ,LE=6.0) 

GRAPH (G2/G2 , DE=TEK618 , PO=0 , .5)  TIME(UN= ’ SEC’ ,LE=0.O), . 
CR(UN= ’RAD’ ) 

*  REF ( SC=2 . 0 , LO=0 , AX=OMIT ) 

GRAPH (G3/G3 , DE=TEK618 , PO=0 ,0.5)  TIME(UN= ’ SEC’ ,LE=8.0) , 
YT( UN =’ METERS’ ) 

LABEL  (Gl)  PHASE  PLANE 

LABEL  (Gl)  XDOT, CDOT, CRDOT  VS  C 

LABEL  (G2 )  STEP  RESPONSE 

LABEL  (G2)  C,CR  VS  TIME 

LABEL  (G3 )  MOTION  OF  THE  ARM’S  TIP 

LABEL  (G3)  YT  VS  TIME 

END 

STOP 


APPENDIX  H 

SIMULATION  PROGRAM  FOR  THE  SYSTEM  USING  CURVE  FOLLOWING 
TECHNIQUE  WITH  THE  ARM  BEING  100  STIFFER 
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TITLE  SIMULATION  PROGRAM  FOR  THE  WHOLE  SYSTEM 
TITLE  USING  VELOCITY  CURVE  FOLLOW  TECHNIQUE  ONLY. 

TITLE  THE  ARM  IS  100  TIMES  STIFFER  THAN  THE  THEORITICAL  ONE. 
PARAM  K1 =0.06, K2= 10000 . 0 , KM=1 . 2000 , VSAT=50 . 000 , K= 1 . 00 
PARAM  REF=0. 1700 , CR0=0 . 0 , T=0 . 00005 , KT=1 . 00 , L=1 . 13 
INTGER  N.SW.SWl 

ARRAY  NUMWM ( 7 ) , DENWM ( 9 ) , NUMTWM ( 7 ) 

*  Kl:  THE  CURVE  SCALLING  CONSTANT 

*  K2:  THE  AMPLIFIER  GAIN 

*  KM:  THE  INITIAL  MOTOR  CONSTANT  OF  THE  IDEAL  (MODEL)  MOTOR 

*  VSAT :  THE  SATURATION  LIMITS  OF  THE  AMPLIFIER 

*  K:  THE  VELOCITY  LOOP  FEEDBACK  GAIN  (OF  THE  MODEL) 

*  REF: THE  COMMANDED  HUB  ANGLE  IN  RAD 

*  T:  THE  SAMPLING  INTERVAL 

*  L:  THE  ARM’S  LENGTH 

*  NUMWM  IS  THE  NUMERATOR  OF  THE  HUB  TRANSFER  FUNCTION 

*  OF  THE  ARM  WITHOUT  MASS  AT  THE  TIP. 

*  DENWM  IS  THE  DENOMINATOR  OF  THE  HUB  TRANSFER  FUNCTION 

*  OF  THE  ARM  WITHOUT  MASS  AT  THE  TIP  THIS  DENOMI- 

*  NATOR  IS  THE  SAME  FOR  THE  TIP  TRANSFER  FUNCTION 

*  NUMTWM  IS  THE  NUMERATOR  OF  THE  TIP  TRANSFER  FUNCTION 

*  OF  THE  ARM  WITHOUT  MASS  AT  THE  TIP. 

TABLE  NUMWM ( 1-7)=46.321, . . . 

1009.8,  .  .  . 

1.  U63678S71E7, 

1 .O3584890O53E8, .  . 

3. 17957559457E1 1 ,  . 

7. 5761380523 5E 11, . . . 

3 . 4066492 163 IE 14 
TABLE  DENWM( 1-9 ) =1 , . . . 

26.0, .. . 

2 . 9803594E5 , . . . 

3 . 90728207E6 , . .  . 

1 . 504060 90 396E 10 ,  . . 

7 . 64 24 38884 20E 10 , . . . 

1 . 54089763177E14, .  .  . 

3. 081 50 15978 5E 13, . . . 

0 

TABLE  NUMTWM ( l-7)=-2. 177, . . . 

-3 . 96214E1 , . . . 

-2 . 55233 322 16E4 , . . . 

-5 . 20524865907E6 , . . . 

-2 . 526229735E10 , . . . 


180 


5 . 71 50755 1855E10 , . . . 

3 . 81407740623E14 

INITIAL 

A=SQRT ( 2 . *KM*VSAT ) 

XDOT=0 . 0 
SW1=0 

YCOM=L*SIN ( REF ) 

R=REF*STEP (0.0) 

DERIVATIVE 

E=R-C 

***********  curve  calculation  *************** 
*********************************************** 

NOSORT 

IF(E.LT.O.O)XDOT=-A*K1*SQRT(ABS(E) ) 

IF(E . GE . 0 . 0 )XD0T=A*K1*SQRT(E ) 

SORT 

XDOTE=XDOT-KCDOT 
KCDOT =CDOT*K 

V=LIMIT( - VSAT , VSAT , K2*XDOTE ) 

CDDOT=KM*V 

CDOT= I NTGRL (0.0, CDDOT ) 

C=INTGRL(0 . 0 , CDOT ) 

OKU=KT*V 

CR=TRNFR( 6 , 8 , 0 . 0 , NUMWM , DENWM , OKU ) 

CRDOT=DERIV(0 . 0 , CR) 

YT=TRNFR( 6 , 8 , 0 . 0 , NUMTWM , DENWM , OKU ) 
***************************************************** 
***********  SAMPLING  OF  THE  ARM’S  HUB  *************** 
*************  POSITION  AND  HUB  RATE  ***************** 
***************************************************** 
SAMPLE 
NOSORT 

IF(N. EQ. 0 . 0 )GO  TO  20 

IF( CDOT. GT. XDOT )SW=1 

IF(SW.EQ. 1 )GO  TO  5 

KS= ABS ( 2 . *CR ) / ( ( ( N*T ) **2 ) * V ) 

KM=KS 

5  CONTINUE 

C=CR 

CDOT=CRDOT 
20  N=N+1 

CONTINUE 

SORT 

TERMINAL 
METHOD  RKSFX 

CONTRL  FINTIM=2 . 0000 , DELT=0 . 00005 , DELS=0 . 00005 
*RINT  0.05.YT 

*AVE  (G1)0. 0001, C, XDOT, CDOT, CRDOT 
*AVE  (G2)0. 0001, TIME ,C,CR 
SAVE  (03)0.0001, TIME, YT 

GRAPH(G1/G1,DE=TEK618,PO=0, .5)  C(UN=’RAD’ ,LE=8.0) , . . . 
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XDOT (LO=0,UN=’ RAD/SEC ’ ,  LE= 12.0), . . . 

CDOT ( LO=0 ,  UN=  ’ RAD/SEC ’ ,LE=12.0) , . . . 

CRDOT ( L0=0 , UN= ’ RAD/SEC ’ , LE= 1 2 . 0 ) 

GRAPH (G2/G2 , DE=TEK618 , P0=0 , .5)  TIME(UH= ’ SEC’ , LE=8 . 0 ) , . 

CR(UN= ’RAD’ , LE=12 . 0 ) 

*  REF(SC=2 . 0 , LO=0 , AX=OMIT) 

GRAPH(G3/G3 , DE=TEK618 , P0=0 ,0.5)  TIME(UN=  *  SEC ’ ,LE=8.0) , 
YT( UN =' METERS’ ,LE=12.0) 

LABEL  (Gl)  PHASE  PLANE 

LABEL  (Gl)  XDOT, CDOT, CRDOT  VS  C 

LABEL  (G2 )  STEP  RESPONSE 

LABEL  (G2 )  C,CR  VS  TIME 

LABEL  (G3 )  MOTION  OF  THE  ARM’S  TIP 

LABEL  (G3 )  YT  VS  TIME 

END 

STOP 


TITLE  SIMULATION  PROGRAM  FOR  THE  WHOLE  SYSTEM 

TITLE  USING  VELOCITY  CURVE  FOLLOW  TECHNIQUE  SWITCHING  TO 

TITLE  LINEAR  MODE  FOR  THE  FINAL  MOTION. 

TITLE  THE  ARM  IS  THE  100  TIMES  STIFFER. 

PARAM  K1=0 . 10 , K2-10000 . 0 , KM=1 . 2000 , VSAT=50 . 000 , K=1 . 00 
PARAM  REF=0. 1700, CR0=0.0,T=0. 00005 ,KT=1. 00, L=l. 13 
INTGER  N, SW, SW1 

ARRAY  NUMWM( 7 ) , DENWM( 9 ) , NUMTWMC 7 ) , NUMCOT( 2 ) , DENCOT ( 4 ) 

*  Kl:  THE  CURVE  SCALLING  CONSTANT 

*  K2:  THE  AMPLIFIER  GAIN 

*  KM:  THE  INITIAL  MOTOR  CONSTANT  OF  THE  IDEAL  (MODEL)  MOTOR 

*  VSAT:  THE  SATURATION  LIMITS  OF  THE  AMPLIFIER 

*  K:  THE  VELOCITY  LOOP  FEEDBACK  GAIN  (OF  THE  MODEL) 

*  REF: THE  COMMANDED  HUB  ANGLE  IN  RAD 

*  T:  THE  SAMPLING  INTERVAL 

*  L:  THE  ARM’S  LENGTH 

*  NUMWM  IS  THE  NUMERATOR  OF  THE  HUB  TRANSFER  FUNCTION 

*  OF  THE  ARM  WITHOUT  MASS  AT  THE  TIP 

*  DENWM  IS  THE  DENOMINATOR  OF  THE  HUB  TRANSFER  FUNCTION 

*  OF  THE  ARM  WITHOUT  MASS  AT  THE  TIP. THIS  DENOMI- 

*  NATOR  IS  THE  SAME  FOR  THE  TIP  TRANSFER  FUNCTION. 

*  NUMTWM  IS  THE  NUMERATOR  OF  THE  TIP  TRANSFER  FUNCTION 

*  OF  THE  ARM  WITHOUT  MASS  AT  THE  TIP. 

*  NUMCOT  IS  THE  NUMERATOR  OF  THE  LINEAR  COMPENSATOR  CONNECTED 


*  IN  CASCADE  WITH  THE  ARM. 

*  DENCOT  IS  THE  DENOMINATOR  OF  THE  LINEAR  COMPENSATOR  ABOVE. 
TABLE  NUMWM( l-7)=46. 321 , . . . 

1009.8, . . . 

1 . 1463678571E7 , . . . 

1 . 0 35848980 5 3E8 , . . . 

3.17957559457E11, . . . 

7. 57613 80 523 5E 11, . . . 

3. 4066492163 IE 14 
TABLE  DENWM ( 1-9 )=1, . . . 

26.0, . . . 

2 . 9803594E5 , . . . 

3 . 90728207E6 , . . . 

1 . 504060 90396E 10 , . . . 

7.64243888420E10, . . . 

1 . 54089763 177E14 , . . . 


3 . 081 50 15978 5E13, . . . 

0 

TABLE  NUMTWM( 1-7 ) =-2 . 177 , . . . 

-3 . 96214E1 , . . . 

-2. 5523332216E4, . . . 

-5 . 20 524 86 590 7E6 , . . . 

-2. 52622973 5E 10, . . . 

5.71507551855E10, . . . 

3. 81 40 77 40 62 3E 14 
TABLE  NUMCOT( 1-2) =3200, . . . 

1600 

TABLE  DENCOT( 1-4) =0.005, . . . 

1.36, ..  . 

80.0,... 

1600 

INITIAL 

A=SQRT ( 2 . *KM*VSAT ) 

XDOT=0 . 0 
SW1=0 

YCOM=L*SIN(REF) 

R=REF*STEP( 0 . 0 ) 

DERIVATIVE 

K=R-C 

*********************************************** 
***********  CURVE  CALCULATION  *************** 
*********************************************** 

NOSORT 

I F ( E . LT . 0 . 0 ) XDOT = - A *K 1 * SORT ( ABS ( E ) ) 

IF(E . GE. 0 . 0 )XD0T=A*K1*SQRT(E ) 

SORT 

XDOTE=XDOT-KCDOT 
KCDOT =CDOT*K 

V=LIMIT( -VSAT , VSAT , K2*XDOTE ) 

CDDOT=KM*V 

CDOT = I NTGRL ( 0 . 0 , CDDOT ) 

C=INTGRL(0 . 0 , CDOT ) 

INPUT=KT*V 

******************************************************** 
***********  SWITCHING  TO  THE  LINEAR  MODE  *************** 
******************************************************** 
NOSORT 

IF(YT. LT . YCOM) OKU = INPUT 
I F ( YT . GE . YCOM ) OKU = OKU 1 

SORT 

CR=TRNFR( 6 , 8 , 0 . 0 , NUMWM , DENWM , OKU ) 

CRDOT=DERI V ( 0 . 0 , CR ) 

YT=TRNFR( 6 , 8 , 0 . 0 , NUMTWM , DENWM , OKU ) 

IN=YCOM-YT 

OKU1 =TRNFR( 1 , 3 , 0 . 0 , NUMCOT , DENCOT, IN ) 

***************************************************** 
***********  SAMPLING  OF  THE  ARM’S  HUB  *************** 
*************  POSITION  AND  HUB  RATE  ***************** 


***************************************************** 

SAMPLE 

NOSORT 

IF(N.EQ.O ,0)GO  TO  20 
IF( CDOT. GT. XDOT )SW=1 
IF(SW.EQ. 1 )GO  TO  5 
KS=ABS( 2 . *CR)/( ( ( N*T ) **2 ) *V ) 

KM=KS 

5  CONTINUE 

C=CR 

CDOT=CRDOT 
20  N=N+1 

CONTINUE 

SORT 

TERMINAL 
METHOD  RKSFX 

CONTRL  FINTIM=2 . 5000 , DELT=0 . 00005 , DELS=0 . 00005 
PRINT  0.05, TIME 

*AVE  (G1 ) 0 . 0001 , C , XDOT, CDOT , CRDOT 
*AVE  (G2)0. 0001, TIME ,CR 
SAVE  (G3)0. 0001, TIME, YT.YCOM 

GRAPH (Gl/Gl , DE=TEK616 , PO=0 , .5)  C(UN=’RAD’ ,LE=6.0), . . . 
XDOT (LO=0,UN=’ RAD/SEC ’ ,LE=6.0), . . . 

CDOT ( LO=0 , UN= ’ RAD/SEC ’ , LE=6 . 0 )  ,  ... 

CRDOT ( LO=0 , UN= ’ RAD/SEC  * , LE=6 . 0 ) 

GRAPH (G2/G2 , DE=TEK618 , PO=0 , .5)  TIME( UN= ’ SEC ’ , LE=0 . 0 ) , . 
CR(UN= ’RAD’ ) 

*  REF(SC=2 . 0 , LO=0 , AX=OMIT ) 

GRAPH (G3/G3 , DE=TEK618 , PO=0 ,0.5)  TIME ( UN= ' SEC ' ,LE=0.O), 
YT( UN =» METERS’ ) , YCOM( LO=0 . 0 , SC=40 . 0E-3 ) 

LABEL  (Gl)  PHASE  PLANE 

LABEL  (Gl)  XDOT , CDOT , CRDOT  VS  C 

LABEL  (G2)  STEP  RESPONSE 

LABEL  (G2 )  C,CR  VS  TIME 

LABEL  (G3)  MOTION  OF  THE  ARM’S  TIP 

LABEL  (G3 )  YT  VS  TIME 

END 

STOP 
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